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ABSTRACT 


Thlfl report proHonta r^'Hoarch Into enttmatJon and control mothoda 
for a "Brag-Free** apucecraft. Thla work reproaenta the functional and 
analytical ayntheala of on-board catlmatora and controllers for an integrated 
attitude and translation control system. An earlier study [4] addressed 
the general feasibility of a drag-free STARPROBE (Solar Probe) spacecraft. 
This effort pursues the basic issues raised In the preceding study and 
creates the framework for detail definition and design of the baseline 
drag-free system. The techniques for solution of self-gravity and electro- 
static charging problems are applicable generally, as Is the control system 
development . 


Ill 


Table of ContentB 


SPACECRAFT DRAG^FREE TECHNOLOGY nEVEWPMENT 
On~Board Estimation and Control Synthesis 

Page 

I . INTRODUCTION • • • 1 

A, Background . ♦ 1 

B, New Issues 1 

C, Purpose of the On-Board Estimator 2 

II. DYNAMICS 3 

A. Orbital Dynamics 7 

B, Spacecraft Translational Dynamics ^ 

C. Spacecraft Rotational Dynamics . 8 

D, Charge Interaction .. ........... 8 

III. SPACECRAFT ATTITUDE AND TRANSLATION CONTROL SYSTEM 9 

A. Control Objectives ................... 9 

B. Control System Description 12 

C. Spacecraft Simulation Program 15 

D. Proof Mass State Estimation 17 

E. Translation Control Law Development 19 

IV. DESIGN OF THE PROOF MASS CHARGE ESTIMATOR 23 

A. The Extended Kalman Filter 23 

B. Model Simplifica.':ion * * * * 

C. Filter Design 

D. Simulations, and Analysis of Results 29 

V . INTEGRAL CONTROL 

A. Rationale for Integral Control Disturbance Reduction . . 38 

B. Integral Control Model 

C. Simulation and Discussion of Results 

VI. KEY CONCLUSIONS AND FUTURE STUDIES 

PRECEDING PAGE BUNK NOT FILMED 


V 


VXI. 


RKFRRRNCRS 


^ 1 £ 

50 


Table 3 
Table 4 


Figure 

Figure 

Figure 

Figure 

Figure 


APl’KNIHX A - DISTURBANCR EPPRCTS 

**'”EN1)1X R - PROOF MASS STATE RHTtMATOR DESIGN 

APPENDIX C - STARPROBE SIMULATION PROGRAM 

APPENDIX D - CHARGE ESTIMATION STMIIUTIONS AND COMPUTER 

PROGRAM 

Al’PENDlX E - CHARGING OF THE PROOF MASS DURING THE STAR 

PROBE MISSION 


List of Tables 

1 Simulation Results for Proof Mass State Estimator , ♦ . . 
1 Simulation Results for Charge Estimation 

List of Figures 

L Near-Perihelion Trajectory 

5 Full Science Configuration 

3 Proof Mass and Cavity Schematic 

4 Attitude and Translation Control System Diagram 

5 Phase Plane Plot of Single-Sided Limit Cycle 


51 

55 

bi 

77 

85 

Page 

18 

33 


4 

5 

6 

11 

41 


Vi 


1 


X . INTRODUCTION 
A. Background 

The Storprobe Hpacecraft has been designed for a study of the nearest 
star to Earth, the Sun, Three classes of experiments have been identified 
for the Starprobe mission. Those ore: fields and particles experiments, 
imaging science experiments, and radiometric/gravitational experiments. The 
perihelion distance of four solar radii will provide a unique opportunity 
for obtaining this science data. 

The close passage of Starprobe to the Sun also allows for precision 
gravitational experiments to be performed. Using Earth -based tracking and a 
model of the sun^s gravitational field, it will be possible to extract 
parameters which describe the sun's gravitational potential. There is 
specific Interest in extracting the sun's quadrupole moment, J 2 , and possibly 
higher harmonics, as well as gravitational parameters which arise due to 
relativistic effects of the sun. However, non-gravltational effects, such 
as solar pressure, would result in such large uncertainties in the gravita- 
tional model that little useful information would be obtained. Fortunately, 
these non-gravltational effects can be almost entirely removed by incorpora- 
tion of a "drag-free" translation control system. The drag-free control 
system concept has been demonstrated on TRIAD, an Earth orbiting satellite, 
and non-gravltational spacecraft accelerations were shown to be reduced to a 
level of 5 x lO^^^g's, The Starprobe spacecraft with such a control system 
In conjunction with ground tracking would be able to provide valuable infor- 
mation on the sun's gravitational field. 

B. New Issues 

-12 

The drag-free system on TRIAD operated at the level of 5 x 10 g's. 
This would certainly be adequate for Starprobe. However, significant 
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dlfformicofl axint botwcon thooa two spncocraft nnd tholr mlnfilon onvlronmontfl . 
Tho grnvlty-Rrndlont RtobtUssod TRIAD npacocrnft wno dodlcntod to proof of 
tho dra«".froo control concept. An fluch, tho entire Bpncocroft wnfi confiRurod 
around this draR-freo Inntrumontatlon, Moving, or variable maafiofl were kept 
to a minimum, and were physically located on booma a largo distance from the 
drag-free sensor. The electromagnetic environment was benign for the 800 km 
Earth orbiting TRIAD. On the other hand the multi-experiment Starprobe is 
not uniquely configured around the drag-free system. In fact it is necessary 
to achieve the required drag-free performance in spite of relaxation in 
spacecraft configuration constraints. Specifically, Starprobe will differ 

from TRIAD in the following aspects. 

1) The Starprobe drag— free control system will not necessarily be 

located at the spacecraft center of mass . This will produce coupling 
between the attitude control and translation control systems. This effect 
is especially pronounced during Imaging slews of the spacecraft (both cross- 
track and in-track during which time drag-free accuracy must be maintained) . 

2) The Starprobe drag-free control system must operate in spite 
of moving antenna, articulated Instruments, fuel depletion, and spacecraft 
thermal distortions. These effects may all result in self -gravity distur- 
bances . 

3) The Starprobe drag-free control system may operate in severe 
electromagnetic and high energy particle environments (solar and Jovian)(7l. 
Should the proof mass attain a net charge due to this environment, electro- 
static forces will degrade the drag-free trajectory. (See also Appendix E.) 

C. Purpose of the On-Board Estimator 

To some extent, increased computational work on board the spacecraft 
can compensate for some of the previously mentioned “new issues." This addi- 
tional computation takes the form of an on-board estimator. 
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TUd banic’. purpoae of tho on-board ootimator la to provide atato 
Information for the attitude/tranalatlon control ayatom; to Incorporate 
aonacd maaa redlatrlbutlon and the proof maan poaitlon for an intoBrntod 
proof maaa trajoctory determination; and to either identify, or minimize the 
effects of proof mosa charge. 

The focus of this report will be on the various aspects of drag- 
free estimation and control for Starprobe, The relevant dynamics will be 
presented, first. This will be followed by sections devoted to each of the 
new issue areas for drag— free control. The results will then be discussed 
and future research needs identified, 

II. DYNAMICS 

In order to describe the proof mass trajectory around the sun, and 
the rotational and translational dynamics of the spacecraft, four vector 
equations of motion are required. Prior to presenting these equations, 
several figures will be presented here for concreteness, and for future 
reference . 

The first figure (Fig. 1) Illustrates the nominal trajectory of the 
spacecraft around the sun. The trajectory takes the spacecraft from north 
of the ecliptic plane to south of the ecliptic plane. The magnified view of 
the trajectory shows the spacecraft nadir pointed. 

Figure 2 shows the spacecraft fixed coordinate system. The +z 
axis is in the shield direction, the +>; axis is up, and the +y axis is out 
of the page. This coordinate system will be adhered to for all translational 

and rotational motions and analysis. 

Finally, Fig. 3 is a schematic of the proof mass in the proof mass 

cavity. Note that the center of mass of the spacecraft does not coincide 

with the center of the cavity in this illustration. 


0.5AU 







REACTION WHEELS (4) 
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A, Orbital Dynnmlpa 

Jt la thn fihloldofl proof mano Itnolf that follown a balllntic 
draH”f>?up trajectory around tho nun, The romalndor of tUn npneocraft worformn 
contlnuoun otationkuoplng about tho proof niQOo, no tho entire apoeoeral't In 
drng-froo. Lot R bo tho vector from tho nun to tho proof mnon, then tho 
orbital oquutlono of motion for vho proof mase in givon by 

M 

m H - 7U(t) + + fgg (2.1) 

In (2,1) U 1 b tho scalar gravitational potential of the Sun; 
and F are electrostatic and aelf -gravity forces respectively; m la the 

8g 

mass of the proof mass. It can be seen in the absence of electroctatic and 
self-gravity forces, and to the accuracy retained here, the proof mass follows 
a purely gravitational path. It is therefore vital to minimize directly 
the electrostatic and self-gravity forces, and to know indirectly their 
residual effects on the trajectory of the spacecraft, 

B, Spacecraft Translational Dynamics 

For the spacecraft as a whole to fly drag-free, a control system 

must be Implemented to maintain the spacecraft relative to the proof mass, 

A prerequisite to controlling the spacecraft in such a manner is a model of 

the spacecraft dynamics with respect to the proof maos. Letting M be the 

mass of the spacecraft, the vector from the center of the cavity to the 

spacecraft mass center, and r the vector from the center of the cavity to 

the proof mass, the equations of motion of the spacecraft center of mass may 

be written with respect to the (inertial) proof mase as follows 
*» »« 

M(P - h - 


( 2 , 2 ) 
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Again, to tho accuracy retained In thla model, tho only forcea 
ahown affecting the apacoernft are tho control forcea, $ , and tho aolar 
proaaure force, The objective of tho tranalatlon control ayatem la 

to keep r small, l.e,, keep the spacecraft centered around the proof mass 
In spite of some center of mass offset. The solar pressure force is continuous 
In nature, while the control force is produced by on-off translation thrusters. 


C, Spacecraft Rotational Dynamics 

Certainly, attitude control la a vital part of the Starprobe mission. 
However, In the past attitude control has usually not been a part of a drag- 
free translation control system. The reason that the topic of attitude 
control must be discussed for the Starprobe drag-free control system Is due 
to center of mass offset from the center of the cavity. Looking at Fig. 3, 

It can be seen that even If the proof mass Is at the center of the cavity, 
a rotation of the spacecraft about Its mass center will produce a relative 
motion of the proof mass In the cavity. Essentially, If the center of mass 
of the spacecraft Is offset from the cavity center, control fuel will have to 
be expended in order to cause the spacecraft to rotate about the center of the 
cavity , rather than about Its center of mass . The rotational dynamics of the 
spacecraft may be simply written as 


d 

dt 


(t . 


f + f 

c sp 


(2.3) 


1 is the spacecraft inertia tensor, u) Is the spacecraft angular velocity, 
and T^ and T^p are control torques and solar pressure torques respectively. 


D. Charge Interaction 

The Starprobe drag -free control system must operate In a harsh 
elcctror..agnctlc and high energy particle environment, [7]. Since the proof 
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maaa muat remain laolnted from the remainder of the apacecroft to achieve 
drag -free performance, the poBalblllty of the proof maaa acquiring a net 
charge arises. Of course, if the proof mass does become charged, eXoctro- 
statlc forces will cause it to be attracted to the apnoocrnft and thus 
deteriorate the drag-free performance. In order to reduce the Impact of 
proof mass charge, a good understanding of how the charge affects the proof 
mass dynamics must be available. The model used for these studies is given 
as 

where all the terms have been previously defined. It should be noted that 
the exact form of the electrostatic force as a function of the proof mass 
charge, the proof mass position, and the voltages on the capacitive proof 
mass position sensor plates has been an area of parallel research^^’^^ 

III. SPACECRAFT ATTITUDE AND TRANSLATION CONTROL SYSTEM 
A, Control Objectives 

The STARPROBE control system is a complete 6-degree-of -freedom 
design which provides both attitude and translation control on all three 
spacecraft axes. Spacecraft attitude control will be required throughout 
the entire mission while translation control is required mainly for the 
drag-free solar encounter phase of the mission. The functional objectives of 
the total control system can be summarized as follows: 

1) Maintain highly accurate and stable pointing control of the 
spacecraft relative to the sun and an inertial attitude 
reference frame. 

2) Provide precise drag compensation and translation control of 
the spacecraft relative to the proof-mass trajectory reference. 
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3) tho control roh uhq 8« f^ncl tho trnnalntlon thrufltorfl 
on/off cyclofl, onpocinlly durlnp tho solnr encounter when 
there is n one-sided solnr pressure Corce octlnR on tho space- 
craft, 

4) Minimize the disturbances on the proof mass trajectory due 

to 8pac*rcraft-proof mass dynamic interactions which arise from 
sources such as electrostatic charges and self —gravity . 

Performance requirements for this control system are derived from 
science experiment objectives, spacecraft design considerations, and the 
environments through which the spacecraft is expected to pass. Science 
objectives were discussed earlier in this report and spacecraft design 
considerations have been studied in other reports . The problems of 
integrating a combined attitude/transiation control system into a spacecraft 
with constraints on mass, power consumption, and unique thermal shielding 
pose significant limitations on the control system design. For example, the 
thermal shielding will necessitate that some of the control system gas jets 
be canted with respect to the major axes of the spacecraft, thus causing a 
decrease in the usable amount of control force and an increase in the amount 
of fuel needed to sufficiently maintain control. For reasons such as this. It 
is very Important to optimize the way in which control actions are taken so 
as to maximize their effect and minimize the fuel required. The control 
system design concept that is currently being developed to provide this kind 
of optimized control is shown schematically in Figure 4. The figure shows not 
only the spacecraft dynamics but also the proof mass dynamics. Because the 
two are coupled, the overall system performance is dependent on both. A 
complete description of this figure and a computer simulation program that is 
based on it Is presented in the following subsections. 
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Figure 4. Attitude and Translation Control System Diagram 
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B. Control Syatom Doncrlptlon 

The* combined Hpacecr’i^t attitude and translntlon control ayntem 
doHlgn ahovm in Figure 4 inc ti;o inert lally referenced dynmnico of the 

pr<x)f maufi. The spacecraft translation control system is required to track 
the proof mass motion (i.c, the proof mass solar flyby trajectory) such 
that the proof mass cavity is centered with respect to the proof mass. This 
means that translation control will be referenced to the proof mass position, 
while attitude control will be referenced to Inertial coordinates. This 
combination is acceptable because radiometric telemetry data from the space- 
craft can be used to determine its position in inertial coordinates while 
the translation control system provides the spacecraft position relative to 
the proof mass. Thus, the proof mass location will be known in inertial 
coordinates. The primary force that will influence the proof mass and space- 
craft trajectories will be solar gravity. In addition to solar gravity the 
spacecraft will havt* solar radiation pressure acting on it. The spacecraft 
will shield the proof mass from the solar pressure so the proof mass trajectory 
will not be affected by it . Solar gravity and pressure are represented in 
Figure 4 by the block labeled "environment." Other forces that will Influence 
the spacecraft and proof mass trajectories will be coupling effects which 
arise from electrostatic charge and self-gravity. These forces will act 
equally and In opposite directions on the spacecraft and proof mass as shown. 
The location of the proof mass in Its trajectory is shown in the figure as 
The summation of solar gravity and pressure forces, coupling forces, 
and control system forces and torques will determine the spacecraft's 
trajectory and orientation. Spacecraft location and attitude are shown on 
Figure 4 as and 0g^^ respectively. The dUlerenoe Xg^^-Xp^j^ is 

the position of the space, raft relative to the proof mass which Is labeled 
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AX, Thifl rolntlvo position AX will dotcrmine the sIkc and direction of the 
coupling forcofl on the apncocroft nnd proof (this topic is dincuaned in 

the subsection on proof mass charge interaction) , AX will be measured by 
a capacitance bridge or optical sensor and is shown on the figure as 
AX (measured values are indicated by a tilda ", and estimated values are 
Indicated by a hat •'). AX is combined with information about current 
control system activity (i,e. number and direction of gas jets that are on) 
and a model of the spacecraft’s dynamics to generate estimates of AX, Ax, 
and AX, Details about the method and procedure for generating these estimates 
are given in the subsection on proof mass state estimation. The estimates of 
AX and Ax are then used in the translation control equations to calculate 
the translation error. A discussion of translation control equations appears 
in a later subsection. Translation commands (or bias inputs) appear as part 
of the translation control design for completeness , Next the summed transla- 
tion error is evaluated by the firing logic to determine if control action 
(i.e. firing gas jets) should be taken. The firing logic is also capable 
of evaluating attitude errors simultaneously, so that a combined but degraded 
attitude and translation control is possible with just a gas jet system.^ 

The firing logic would then enable the appropriate gas jets so as to reduce 
the control errors. 

The attitude control loop is a proportional control design which 
works Independently of the translation control system to maintain attitude 
stability. The spacecraft attitude can be sensed by sun sensors and star 
trackers during cruise and by gyros during close encounter. The measured 

m 

attitude 0 is used by a simple first order filter to estimate the attitude 
rates, 6 and 9 are then used in the attitude control equations to calculate 
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the attitude error. The attitude control, equatlona are a rate pXun ponltlon 
feedback combination of the form 

A 

where In the commanded attitude and in a programmable rate-to-poaltion 
gain which provides damping to the system and can be selected for optimum 
performance. The attitude error 0^ which results from this calculation 1s 
then directed to a reaction wheel control subloop which in turn applies the 
appropriate torques to minimize the attitude error. Although a selection of 
gas jets or reaction wheels can be made, reaction wheels will be the primary 
attitude control actuators. There will be infrequent intervals, however, 
that will require gas jets to provide de-saturation of the reaction wheels. 
This completes the description of the attitude and translation control loops. 

■^Although the concept of using the canted hydrazine thrusters for both 
attitude and translation is feasible, it will not satisfy the precision 
pointing objectives stated earlier. Using only gas jets for control would 
also heavily cross-couple attitude and translation loops and lead to much 
more complex limit-cycle control laws for both controllers. Using thrusters 
for translation control and reaction wheels for proportional attitude control 
allows these two control functions to be minimally coupled only through any 
center-of-mass offset from the proof mass cavity center. Thus, the 
behavior of each function tan be made nearly independent of the other, 
resulting in a less dynamic and more stable spacecraft having the capability 
to meet all the scientific goals of the STARPROBE mission. 
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C, Spacecraft Simulation Program 

A digital computer spacecraft nlmulatlon program (Appendix C) 
waa created for the purpone of studying the control performance achievable 
with the proposed control system design. This typo of computer program 
Is an Important analysis tool because it can demonstrate system level 
performance with respect to changes in any of the three principal elements 
which influence control performance, (a) the environment to which the space- 
craft will be exposed, (b) the spacecraft design, l.e, configuration and 
mass properties, and (c) the Individual components of the control system, 
l.e. sensors, actuators, on-board computer hardware and software. The 
modular structure of the program allows the user to make changes in the 
aforementioned areas by simply substituting more information Into the 
appropriate block of data or calculations. An example of this is the specifi- 
cation of the spacecraft inertia tensor which is the first block of user- 
specified data in the program (refer to Appendix C) . The program version 
which is listed uses a simple tensor with zero value inertia cross products. 

If an updated inertia tensor should become available it can be incorporated 
into the program by substituting the new values including non-zero inertia 
products. The program has been designed to handle the full 6 degree-of- 
freedom dynamics problem but may be used for reduced order studies equally 
as well. To aid the user, most variables and blocks of calculations or 
data are well annotated in the program. The construction of the program 
exactly matches the block diagram structure shown in Figure 4. Once this 
block diagram is understood it is easy tJ find the corresponding blocks and 
information flow paths in the simulation program. After the desired models 
(i.e, sensor, actuator, mass properties, environment, etc.) have been 
chosen and incorporated into the program the user may select the maneuver 
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to bo fllmulntPcl. ThoRO monouvoro Include opncocroft turnfl on any nxia, 
ncqulflitlon of coloatial roforoncoa, or raaintonnnco of otoady atato pointlnp 
nnd poaitlonlnR. Maneuver aoloctlon rIvoo the analyat aovoral control modoa 
for Rtudylnp, control porforraano.o. In addition, the unor may opoclfy prool 
maoa and apacocraft Initial condltlona (poaltionH nnd ratoH) . Overall the 
program is very flexible and la canlly used to study a wide range of control 
problems. The program is written in Continuous System Simulation Language 
in a manner so that someone with minimal computer experience will understand 
it. Some experience with the JPL UNIVAC computer system is necessary for 


running the program. 

After the program was developed it was first used to study the 
performanoe of the on-hoard proof mass state estimator which Is discussed 
in the next subsection. This was a natural choice for the first set of 
simulation runs because estimator performance can be Investigated with 
a minimum of program complexity. It Is desirable to eliminate all error 
sources except the estimator from the control system In order to study 
only estimator performance within the framework of the total system. 

This was accomplished by using "Ideal" models for all of the control 
system's sensors and actuators except for the AX sensor. Simplified 
models of the environment, spacecraft dynamics, and control laws wore 
al o employed to mlnlmlte the complexity and cost of conducting the 
inyostlgntlon. The program listing which appears ns Appendix C Is a 
copy of the progrom version that was used In the proof mass statu 

estimator performance study . 

The simulation program Is currently being used to study and 
develop the translation control laws. For that study the proof mass 
estimator equations and AX sensor model are replaced with Idealised 
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vorslonn oo that the tranfllatlon control porformonco U solely dependent 
upon the control laws. The versatility of the proRrom allows the analyst 
to study not on3,y major system changes (o.g. control with and without a 
proof mass state estimator) but also parametric changes (e.g. controller 
and eetimator gain variations) , 

D, Proof Mass State Estimation 

The purpose of the proof mass state estimator Is to provide 
accurate estimates of the proof mass position and velocity with respect 
to the S/C frame. This Information Is required by the translation control 
system and the various error compensation models that incorporate proof 
mass position dependent forces (such as self-gravity and charge distur- 
bances) , As this estimation Is to be done on board, computational 
simplicity is an important consideration in the estimator's design. 

Initially a Kalman filter based on the full dynamics was 
designed. This 6-state estimator has the form 

X “ F(w,u),p ,p ,p)x + PH'^R"’^(y-Hx) + u + a (3,2a) 

8p 

# » FP + Pf'^ + Q - Ph'^r"^ HP (3.2b) 

where y is the vector consisting of the three proof mass position measure- 
ments, H is the 3 X 6 matrix selecting the observed states (position), 

Q ^ 10 mm /sec diag (0 1 0 1 0 1) is the filter-assumed spectral 
density of the process disturbance, and R « 2,5 x 10~^mm^scc diag (1 1 1) 
is the spectral density of the measurement disturbance. 

The sensitivity of the estimator to the arguments of F was 
exercised by assuming either complete knowledge or no knowledge of these 
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pornmotOT-R durinR n Rlmulntod 3" yaw turn. In the first simulation coroplste 
knowlodRo of tho parameters was assumed , Furthermore the center of mass 
was taken to bo at the cavity center and stationary. In the second slmu'’ 
lotion the cantor of maos was oRnln taken to bo stationary, but displaced 
10 cm along the «-qx1h. As this estimator hod nolthor knowledge of this 
displacement nor knowledge of the angular terms, u>, and w, the argumonto 
of F were set to zero in this simulation. In each simulation a colored 
noise process disturbance with variance 10 ^mm^/sec^ and correlation time 
of 10 sec was present. Also noisy position measurements (Gaussian, zero~ 
mean. Independent, lo » .05 mm) were available every 10 milliseconds. 

The results of the simulations are given in Table 3.1 below. 

Table 3.1. Simulation Results for Proof Mass State Estimator 


Average Absolute Error 


Simulation 


'x 


^2 

1 

-3 

6.16x10 mm 

_3 

9.00x10 mm/sec 

..3 

8.39x10 mm 

9 . 32x10 mm/ sec 

2 

6 «23kX 0 mni 

-3 

9.31x10 mm/sec ^ 

8.89xl0"^mm 

•3 

9,31x10 mm/sec 


First note that without filtering the average absolute error in 

the position measurement would be about .04 mm (X“N(0,2 .5x10 ^mm^)*^E|x j* .04 mm). 

Thus the filter improves the measurement accuracy by more than a factor of 

four. Next note that there is negligible gain in including the arguments 

of F into the filter. This is easily explained. Executing the yaw turn 

results in ju) | <2xl0"^rad/secand [u ! <1.25xl0“^rad/sec^. Coupling 

y tn£ix y incxx 

these values with the bounds |rl<5mm, |r |<1.5mm/sec, and |pl<100mm reveals 

2 

that the acceleration due to the kinematic terms is less than ,01 mm/sec 
in thest^ simulations. This value is in the noise level, and thus has little 
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1 

I 

tmpnct pn fUtpr porforronnco. Wp mny nhorofpro dnlotp CPrmrt In thp flltor '[ 

dPHlRn. Thin In fortunnto In that thn nntlmntor (3.2) In fully cpuplnd nnd 
tlmo-vnrylnR, whllu tho nuppronnlon of Chotip tnrmn londn to n docouplod | 

ontlmator that allowa atoady ntato Ralnn (aoo Appondlx D for dnalRn) , ' 

! 

E, Translation Control haw Dovolopmont ,i 

I 

In Suction V of thlo report translation control concupts such os j 

i 

singlc-sldud limit cycling and integral errors arc presented. These ] 

concepts were demonstrated using a simple single oxlo control case. It is 1 

shown that these concepts would enable the system to meet the translation 
control objectives which are to; 

(1) Maintain stable spacecraft positioning control relative to 
the proof mass, and be compatible with attitude control, 

(2) Minimize the control gas usage and the number of thruster 

on/off cycles, * 

(3) Minimize spacecraft Induced disturbances on the proof 
mass trajectory. 

Currently the concepts which were demonstrated for the single axis case 
are being studied to determine how they apply to the full 3-axis controller. 

The 3-axis controller has many more constraints than the single axle 
controller does. One of the most Important concerns for the 3— axis controller 
design will be the effects of having gas jets canted with respect to the space- 
oral t's principal axes. The heat shield configuration requires that the 
gas jets be canted. The canted jets will not only require more fuel, (as 
compared to non-canted Jets) but also can result in a further loss of 
control forces due to plume Impingement onto other parts of the spacecraft. 
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OnntPd Rnn joto wlU nlno lo«d to cronn-eouplpd control foroon which wlU 
drive tho dondbnnd limit cycllnR In n nmnnnr tbnt In not yot defined . A 
bettor definition of tho npncocrnft conflRwrntlon and hont nhlold donlRU 
IM nocoflfmry boforo tho problomn of eonted Ran Jotn can bn fully nnnlynod. 
Another concern which arioeo In the dcolgn of the 3-nxin controller In how 
much the attitude and tranolatlon control functlono are decoupled, If the 
gas Jots alone arc used for both attitude and translation control, then 
realistically these functions cannot be decoupled. The reaction wheel 
approach avoids having to contend with this severe control problem, and 
enables compatibility with the previously stated control objecaves. 

Proof mass charge is yet another major concern in the design of the 
3-axis translation control laws. Referring again to Hgurc 4 it can be 
seen that the coupling effects of charge will create positive feedback 
loops around both the proof mass and the spacecraft. (This is obvious 
because the static charge creates a larger attraction force the closer 
the proof mass is to the cavity wall.) This destabilizing force is primarily 
a function of the charge magnitude and the separation distance between the 
proof mass and the cavity wall. (Refer to section IV for a more complete 
discussion on proof mass charge effects.) The control system design 
problem Is then to determine how the separation distance should be 
regulated so as to minimize the destabilizing charge effects and also 
minimize the amount of control gas expended. If the proof mass were always 
kept exactly In the center of the cavity then there would be no net charge 
force and the destabilization problem would never occur. To do this 
however, would obviously require a much higher control authority, which 
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impliPH tbrtt n prpotpr amaunt pf control onorfiy munt bo opont. If minimum 
fuol oxpondlUuro worn the only Ronl then tho Htntlc chorpo forco would bo 
nllowod to drlvo tlui proof mnoH nwny from n porfoct nolnr pravlty trnjoctory.* 
Howovor, tho control oyntom donlpn munt try to mlnlml^o both fuol oxpondl" 
turo and proof raann dlnturbaneoo . Tho IntcRrnl control approach dlncunnod 
in soctlon V,fl lo one mothod thot offero juot such a bonoflt. Although 
tho Integral control concept has been InveHtlgutcd for a olnglc nxla model, 
a 3-axio development huB not been done yet. There are several queatlona 
that need to bo studied before a 3-axis controller can be completely designed: 
One Important question is how should the control strategy for the x and y 
axes differ from the z axis, since it doesn't seem likely that x and y 
deadband limit cycling will be single-sided like the z axis. Heat shield 
asymmetries, thermal warping, and non-nadir attitude will all give rise tj 
X and y axis disturbance forces which cannot be predicted to the same level 
of confidence as the nominal solar pressure force. Since t» e signature of 
these forces cannot be predicted, the translation control design must provide 
performance that is as insensitive as possible to these disturbances. 

No matter what control concept is selected for the 3-axls system there 
are still other constraints that will Influence the control design and perfor- 
mance: One parameter that needs to be studied is the controller bandwldtlu 

This may be a very important parameter if flexible structures are to be 
attached to the main spacecraft body. Rotating science platforms may also 
Influence tho control design since they could create additional disturbances 
due to mass and momentum unbalances. Any rotating parts may have a momentum 
vector that will interact with the controller thus making the bandwidth 
parameter even more important. One other study which must be done to 
support the controller design is to determine a method for selecting control 
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«ftl.nfi. RiumuHo of the. rnpid chanRO in Rolnr pi-onRurc during the cIoho 
encounter it mny be noeoaanry for the control anlnn to vnry nlBO, It haa 
not yet been determined If time varying or atate dependent control fjoin 
wllx be required. If they arc required a method for ascertaining the appro- 
priate gains must bo developed. 

In summary, it is clear that the control system performance must 
remaii' relatively constant over a very wide range of disturbance environ- 
ments . To meet this goal it is evident that several important technology 
areas still need to be investigated before a 3-axis controller design can 
be adequately specified. 

*lt has been proposed to identify the static charge by perturbing the proof 
mass with a known force and observing its resulting motion. Any uncertainty 
in the perturbation force will only add to the existing uncertainty about 
the charge. This would make the problem of controlling the spacecraft 
with respect to the proof mass even mere difficult. In the case of a large 
perturbation force, or static charge force, the proof mass motion can become 
too fast for a low bandwidth controller to track (this has been demonstrated 
using the spacecraft simulation program). This would result in a loss of 
spacecraft stability relative to the proof mass. It is felt that one of 
the coutrol objectives must be to minimize the disturbances on the proof 
mass trajectory caused by charge, even if the magnitude of the charge is 


unknown or unmeasurable. 
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IV, DESIGN OP THE PROOF MASS CHARGE ESTIMATOR 

Although the proof mosB In the drag-free system for Starprobc 
is shielded from forces external to the spacecraft, there are several 
factors within the spacecraft environment that can significantly degrade 
drag-free performance. Among these is an attraction of the proof mass to 
the cavity shell due to charging of tU rroof mass. See Appendix E 
and t7J. 

A possible solution to this problem is to obtain a reliable 
estimate of the charge and then include it in the error compensation model. 
However, this cannot be done a priori since predictability of the exact 
charge is not possible. This constraint suggests a filtering approach to 
the problem. To this end a charge force model has been developed ([1],[2D 
that describes the motion of the proof mass as a function of charge, 
the position dependent capacitance of the ball-cavity system, and the plate 
potentials. (For a complete discussion of the details the reader is 
referred to Alwar fl].) Incorporating this dynamical description into the 

disturbance model (32) the charge becomes “observable" through the position 
of the proof mass. 

In this section an extended KaLnan filter la developed for the 
purpose of charge estla^tlon. Also the effect of varying parameters on 
filter performance is analyzed, 

A. The Extended Kalman Filter 

Before addressing the specifics of the problem of charge estimation, 
an overview of the general methodology sluill be discussed. 

For brevity we shall write the modeled proof mass equations of 

motion as 


r = f(r,q,t) -f Wj. 


(4.1) 
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whore r la a h-^lroenaional vector reproRontiuR the poaitiion ond velocity of 
the proof mnaa in the cavity, q la the charRO, t la time, and la a 
white nolac proceaa roproacatlnR a random accelorntlon. The Inclualon of 
the nolae terra w. con improve filter performance In the presence of unraodeled 
forces [3]. Since this la typically the case when moklnR the transition from 
a true physical system to a mathematical representation of the system, 


Including such a term is customary. 

Now assume q is constant or a slowly varying parameter. We then 
model q as a Brownian motion and append it to the state x to obtain the 
augmented state vector x - [^] . Thus (4.1) can be rewritten as 

X » i(x,t) + w(t) 

where f ■= 1^1 and w^. » [l[] with z^. the white noise process driving q. 

With the capacitive pick-off sensor (or an optical device) the 
proof mass position is measured. This observation process can be described 

as 

yj - Hij + vt 

where y^ is the measured observation, H is a matrix selecting the observed 
states (position) , and v^. is a white noise process representing the accuracy 
of the measurements. Given the spectral densities of the w^. and v^ 
processes, say Q a,*d R respectively, equations (4.2) and (4.3) define a 
filtering problem, i.e., determine the unbiased minimum variance estimate 
x(t) of x(t) given the observations {y(s): s ;f^t}. 

The solution to this problem is In general Intractable. But In 
the case that (4.2) Is linear i.e. f(x,t) = F(0 x(t), the solution is 
given by the Kalroan-Bucy filter; 


X ■= Kx + ni‘R“^(y - Hx) 
p o FP + PF* + Q - 


(4 .4a) 


(4.4b) 
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In the problem that concorna ua f la nonlinear. However, the 
linear roault above can be applied to thla problem by llneariain^ about 
a known trajectory. The extended Kalman filter ia baaed upon linear Issat ion 
about the eatlmated trajectory. The contlnuoua version of these equationa 
la 

X - f(x,t) + PhV^ (y - H^) (4.5a) 

^ ^ (x.t) P + P (x,t)}'^ + Q - PH^R“^HP (4.5b) 

An Important feature of the extended Kalman filter is that the 

T -1 

gains, PH R , must be computed in real time. This drawback occurs because 
the covariance equation (4.5b) involves the filtered trajectory x, which 
cannot be known a priori. 


B. Model Simplification 

For completeness the electrostatic force model along the z axis 
is given below, [1,2] , 


j K(Vj+V3)+ -3L a . ( f v^) ) 

l«l 


+ 5^ £„{2F(V3+V3)(V2+Va+V5+Vj) + 2 0(V2+V^) (Vj+V^) 
+ 2 I V 3 V 3 + 2J(V2Va+V5Vj) + L(V3^+V32) 


i»l 


(c,b) 


^ (B(Vi+V3)+D(V2+V^-fV3+V,)) - ^ 

o o i“l 

^ t) 2 2 

■ -R- <B(V^+V3)+D(V2+V^+V3+V^))( f V^) - ^ 

1®1 


^ r ^‘'' r '' 3 » V '' 6 > '» - - R — ' 


(4.6) 
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whore q >=> choree, V » potontlnl on 1 plate, and Che other termn are known 
conHtantH derived from the conf lp,urntion of the drag-free oensor. To 
deduce the charge from proof moss motion thia model must be inserted into 
the disturbance model. The resulting equations of motion simplify consid- 
erably under the following assumptions; 

(1) the center of mass of the S/C is fixed, 

(2) the S/C angular rates are zero, 

(3) the plate potentials on the z-axis are of equal magnitude 
and opposite sign, and the remaining plates are grounded. 

Ihe first two assumptions allow us to set the basic requirements 
for charge estimation - voltages on plates, accuracy of measurements, level 
of charge, etc. Once bounds on these parameters are established, then we 
can proceed with the analysis of introducing S/C angular rates and a non— 
stationary center of mass. The third assumption, although a matter of 
convenience, is easily justified by noting that the force due to charge 
along any given axis is independent of the other axes. Hence, the charge 
1s not observed through the coupling terms , and consequently this assump- 
tion has no Impact on estimator performance. 


C. Kilter Design 

With the assumptions above, (4.6) conveniently decouples and it 
is sufficient to consider the dynamics along the z-axls 


^ (V=(t) (2L - i!^) + + u(t) + 


e b"R 
0 


% (4.7) 


wljere 


r = displacement (meters) 
q = charge (coulombs) 

V(t) = potential (volts) 
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" permittivity of free npnee (8,854 x lO”^^ fnrada/m) 
m " mnsa of proof mnsR (.2 kg) 

a “ radlufl of proof maas (.011 m) 

b ■ radius of cavity (.020 m) 

u(t) ® modeled control law (see sec. III) 

u = modeled acceleration due to solar pressure (10"^m/sec^) 

f^ “ sum of unmode led /mlsmodeled accelerations, 
and, corresponding to a/b = ,55 (see [1]) 

A « 3.317 

L « 6.424 

N « 1.466 

P ■= 1.203 

R = 15.36 


Since the disturbance term f^ in (4.7) is unknown, in the filter 
design it is replaced by a white noise process w^ (recall that this is 
required for stability of the steady state filter). With the assumption 
that q is constant over small time durations (500 seconds) , the filter 
will be designed from the dynamics 


(4.8) 


X = 2V(t)q pA J. ^o 4p^A^, . , ... 

2 mbR ^ ib R“) Sp \ 

q “ 0 


t ‘b‘R 
o 


and the observations 

y=Xi+v (4^9) 

where - r^, X 2 “ r^, and Vj. la again a white noise process reflecting 


measurement uncertainty. 
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Nott^ that (4.8) in nonlinonr, Thun we shall make uae of the 

extended Kalman filter, het Q and r denote the spectral densities of the 
T 

to w 0] and v processes respectively. Then making the appropriate sub- 
stitutions into (4.5a) and (4,5b), the extended Kalman filter for this 
problem is 





Before proceeding with a discussion of filter performance, some 

general remarks on the structure of this filter are in order. 

The need for resorting to an extended Kalman filter for charge 

2 

estimation arises because of the nonlinearity iiitroduced by q in (4.8). 

If this terra did not appear, then the filter constructed above v;ould 
reduce to the ordinary Kairaan-Bucy filter. Furthermore, If we have the 
following strong inequality 
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« V^t) [21. 

o 


(4.10) 


(l.e. when the aigniflcance of the nonlinearity dlminiahea) , we would 
expect the performance of the extended Kalman filter to be almilar 

2 

to that of a Kalman-Bucy filter designed without knowledge of the q 
term. 


Now suppose (4.10) holds and consider the Kalman-Bucy filter just 

described. By adding a noise term in the model dynamics for q (equation 

(4,8)), it was determined that the resulting Kalman-Bucy filter is uniformly 

completely controllable and observable. Moreover, since the model errors 

2 

are bounded (the deleted q term is included here now) , it can further be 
shown that the true covariance of the state estimate is uniformly 
bounded [3] . 

The conclusion from this is that we are reasonably assured that the 
extended Kalman filter will "work" in some fashion, i.e, the estimated 
state will not diverge from the true state, 

D. Simulations, and Analysis of Results 

The parameters exercised in the simulations include charge, 
observation noise, process noise (disturbances), and plate potential 
amplitude and frequency. As only one proof mass-cavity configuration was 
used, the capacitance coefficients and the proof mass radius and mass were 
fixed in the simulations. 

Below we give the range of magnitudes these parameters were allowed 
to take, and the rationale behind the choice. 

*-11 

Two values of charge were selected to be estimated, 10 coulombs 
and lO”^^ coulombs. The first value is near the bound at which the charge 
begins to degrade drag -free performance (l.e. producing accelerations 
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^9 2 

grontor than 10 m/f)oc ), while the oecond value roprcfiontfl an apontorlorl 
upper bound on the charge for the filter to be viable (we’ll get to thin 
later) , 

In each of the aimulationa it was assumed that noisy proof mass 
position Information was available every 10 milliseconds. It was further 
assumed that the sensor noise was zero-mean, Gaussian, and Independent, 
Standard deviation values of 5p and 50p were chosen to exercise this 
parameter , These values are in the range of realistic displacement sensor 
resolution. 

The process noise reflecting the unmodeled/mismodeled disturbances 
was always taken to be a stationary, exponentially correlated Gaussian 
process . The time constant of the process was varied between 10 sec and 
50 sec, and the variance of the process was varied between lOOp^/sec^ 
and 2500 y^/sec . The reasoning here stems from the anticipation that a 
major contributor to the disturbance will be a mlsmodeled (non-steady 
component) solar pressure. Thus the variances reflect the assumption that 
the disturbance magnitude is between 10% and 50% of the modeled solar 
pressure. The choice of time constants expresses the belief that the 
dynamics occurs at low frequencies associated with attitude motions and 
heat shield asymmetries or surface irregularities. 

The proof mass was excited by a square wave potential in each 
simulation. This choice is useful for charge estimation in that a "dither” 
due to the charge effect is superimposed on the proof mass trajectory at 
a known frequency. Presumably if this frequency is sufficiently isolated 
from the effective frequencies of the unknown disturbances, then the 
estimate of charge will not be seriously degraded by these disturbances. 
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Tho frequonclofl oolpcted ranged from .03 hz to ,5 hz, and the potontlala 
ranged from 2 j0 v to 1000 v . Thooo valuoa wore driven to a groat extent 
by the other parametora , 

Given a particular sot of poramoters, obsorvatlono wero generated 

via oquatlono (4.7) and (4.9). The filter designed for a set of parametoro 

was obtained via equations (4.8) and (4.9), with r - (o . 1 standard 

deviation of measurement noise) and Q = lOOu^/sec^. The initial estimate 

of the charge was always taken to be zero. Also the Initial variance P««(0), 
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was selected so that 3 = P33(0), 

Before examining the specif ico of the analysis, a criterion for 
judging estimator performance is necessary. 

Recall that the drag free objective is to assure that unmodeled 
accelerations on the proof mass do not exceed lO^^/sec^. From equation 

(4.7) It follows that the acceleration due to charge alone (l.e, when v “ 0) 
is 


o 

Thus to guarantee that the absolute difference betwee* the estimated and 
actual acceleration is less than 10 ^m/sec^, it is necessary that 



10“^e mb^R 
o 

^z\ ln+q|N 


- 1*5 X 10~^^ 


(4.12) 


with the Inequality above In mind, we create three categories for ranking 
filter performance. They are: 

Category A - Estimator satisfies (4.12) with Ir I « 4.5 x 10^ m over 

z 

the last 50 sec. of the run. 

Category B - Estimator satisfies (4.12) with |r I = 2.25 x lo"^ m over 

z 

the last 50 sec. of the run. 
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Category C - The complement of categorlen A and B. 

Thone rnnklngn bafilcnlly give n mennure no to how narrow the 
deadband In the trannlatlon control nyntem munt be net to attain the required 
drag free performance. 

An unfortunate ramif;l cation of (4, ,12) la that the greater the 

charge, the more, preo.lae the estimate ncedu to bo. To put this Into 

“12 

perspective, assume an actual charge of 5 x 10 coulombs Is to be 

estimated, T.n this case an estimate of 0,0 is acceptable. On the other 

“9 

hand if the value of the charge Is 10 coulombs, then it would be necessary 

“14 

for the estimate to be within 10 coulombs , 

The simulations that were performed are presented in Table 4,1, 

We shall first investigate the results of the simulations 
“11 

involving a charge of 10 coulombs. Substituting into (4.12) we find 

A 

that the estimate q must satisfy 


-12 

8.2 X 10 

-12 

5.8 X 10 



1.15 X 10 




1.29 X 10 


■11 

■11 


- category A 

- category B 


(4.13) 


Note that only one simulation (//6) at the lower voltage made the 
A category. This is not surprising since a higher voltage results in a 
greater "dither" of the proof mass , The role of the voltage and frequency 
is most readily observed in the propagated variances. These variances 
reflect how well the filter "thinks" it is performing. It is apparent 
from Table 4,1 that higher voltages and/or lower frequencies result in 
smaller variances. Now since the acceleration due to the quadratic charge 
term is independent of these parameters , we are led to conclude that the 
bulk of the identification la done through the linear charge term. This 
too Is not surprising, since with this set of parameters (V“250- 1000 
q=lU coulombs) the q acceleration dominates the acceleration by 2-3 


orders of magnitude 
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Tablo 4.1. Slroulnrlon Ronultn for Charp,o Rotimntlon 


^mif 

Chorgo 

Voltage 

1000 V 

Proguonej^ 

,5 he 

ObfiorvoCion 
noien lo 

Proeo88 Tctrmlnnl 

nolno(la.c.orr,/tlffif») Vnrlflnno’* 

RgnU 

1 

lO'^^coul 

Sm 

lOu , 10 eoc 

1.76xl0"^’coul^ 

A4- 

2 

It 

It 

,1 he 

II 

II II 

1 

.l,24xl0“^^coul^ 

C 

3 

II 

II 

,05he 

It 

II II 

1 

1.21xl0‘^^coul^ 

C 

4 

II 

II 

•1 he 

II 

It , 50 sec 

l,24xl0“^^coul* 

c 

5 

11 

II 

•2 he 

It 

, 25 sec 

l,34xl0“^^coul^ 

A 

6 

II 

250v 

II 

tt 

It II 

l,78xlO"^^coul^ 

A-^ 

7 

II 

lOOOv 

II 

11 

50 u» 

l.SAxlO-^^coulZ 

B 

8 

It 

It 

It 

sou 

10 U, “ 

2.30xl0“^^coul^ 

fi 

9 

It 

250v 

•5 he 

5u 

10 U» 10 sec 

2.23x10“^^ coul^ 

B4- 

XO 

II 

lOOOv 

II 

SOU 

It II 

> 

2,58x10"^^ coul^ 


11 

It 

II 

b 2 he 

5v 

»» , 10 sec 

l,3AxlO‘^\oul^ 

A 

12 

11 

It 

e5 he 

II 

lOOUy *005 sec 

1.76xl0"^^coul^ 

B- 

13 

10“^°coul 

II 

o2 he 

It 

lOUi 25 sec 

1. 35x10"^ ^coul^ 

B 

14 

11 

11 

It 

SOu 

II II 

» 

2.32xl0“*\oul* 

C 

15 

11 

250v 

II 

su 

II II 

> 

2,09xl0"^^coul^ 

C 


'^thls 1 b the filter propagated variance » not the actual variance. 
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Npxt, notp thnt notiP of thn olmlntionn with ohoorvotlon nolno 
of 50n mndo tho A cntoRory. Thlfl cnn bo oxplftlnnd by thn foUowlnR 
njTRumont , 

PocunlnR now on tho q=torm, nlnoo thin In whnt tho filter prlmnrily 
ronpondn to, q qulak computntion yioldn 1 ?.V<iPA| ® Ip/nor.^ (for V“1000). 

Thoroforc ovor n period of T ticcondo in which V “ eonntant, the porturbntion 
AZ, due to thio uccoloratlon iu approximately 

Az o -H ~ 1] (micronfl) (4.14) 

2Y^ 

where , , 

A /»2.2 

r - |V| /ff (2t. - = .14 

Taking T “ 2.5 sec, we get a "dither" antplltude of about 3.15 M. 

Obviously a 50p resolution displacement sensor is going to run into a 
sensitivity problem here since the motion is down at the l/15o level. This 
problem however, does not occur with a 5p sensor. 

Referring to (4.14) we see that increasing V or T results in an 
exponential increase in the dither. Although Increasing the voltage would 
significantly enhance the identification, the trade-off in the translation 
control performance quickly becomes intolerable (see Sec. 111). The alter- 
native then is to decrease the dither frequency . Unfortunately this too has 
its drawbacks - which brings us to the role of process noise. 

The parameters of the disturbance were exercised in simulations 2, 4 

and 7. The results indicate a great sensitivity to the correlation time of 
the process, and a lesser sensitivity to the variance of the noise process. 

Loosely speaking, the failure of the filter in these simulations 
can be attributed to the disturbance having too much power at the dither 
frequency. It is easy to see how the filter breaks down in this case. The 
acceleration due to charge is approximately Ip/sec , while the disturbance 
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Is one ordp.r of mnfiulf.udo grontor, Obviousiy, If the disturbance 
hw» subotantlaX npoctraX content at tho excitation froquoncy convorgoncn 
wiXX bo nXow, and not noconnarily to tho correct value, Tho following 
"worst enno*' oxampln illuntraton thin point, 

Suppoiui tho dloturbnnco, and tho pinto potontinls nro both 
constant. In thin unno the effect of the chorgo is virtunlly Indintingulnhable 
from tho dioturbnnco. As a result tho filter will ottributo tho disturbance 
to the charge. Now when the charge is constant or slowly varying tho filter 
boltovcs it learns its value very well. Consequently, tho relative error 
in the estimate will be |£j|/lusec^, 

2 

Based on the simulation results (where » lOu/sec , lo value) 
and the example above, it is clear that "dltheriitg" substantially reduces 
estimation errors due to mismodellng. 

So on the one hand we would like the dither to be fast to reduce 
model errors, while on the other hand we require it to be slow enough to be 
visible to the sensor. 

There are a few other deductions that can be made from the illus- 
tration above. To this end rewrite equation (4,7) as 

r^ ■= k^Vq + + f^ (4.15) 

q “ 0 

Note that the disturbance now incorporates the quadratic charge ter**.. 

Suppose a Kalman-Bucy filter is derived for this dynamical system (with 

fj replaced by a white noise disturbance model and the same observation 

process in (4,9)), It is not difficult to show In this case that the variance 

In the charge estimate P^^(t)-K) as t->«. We would therefore anticipate the 

terminal variances to be near zero. This, however, was not the case. The 

—23 -22 

terminal variances were In the 1,3 x 10 to 2,4 x 10 coulomb range, 
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loRfl thrni two orders of magnitude) undor tho initial vnrlanco. Although 
it may be argued that the covariance in the extended Kalman filter la coupled 
to the state eatimate (while the Kalraan-Bucy filter is not), and hence 
susceptible to model errors, it was found that the principal drivers of the 
variance wore the parameters Independent of the disturbance - voltage, 
dither frequency, and observation noise, (And as to be expected, higher 
voltage, slower dither, and better observations produced smaller variances,) 
Furthermore, a white noise simulation (//12) produced errors consistent 
with the propagated variance (lo error “Ax lO"^^ coulombs) , Prom this we 
conclude that the filter believes it needs more time to converge, l,e,, It 
is still sensitive to new observations after 500 seconds. 

Convergence can be hastened by increasing V, decreasing R, or 
decreasing Q. If we choose to have the filter conform to the model, the first 
two possibilities are out of the question by virtue of previously discussed 
constraints. This leaves us with the selection of the spectral density Q, 
which is essentially a reflection of how much the model deviates from reality. 
Thus not only is the filter sensitive to model errors , it is also sensitive 
to its perception of these errors. 

The obvious conclusion to be drawn here is that given the existing 
constraints on plate potentials and sensor resolution, a more thorough 
understanding of the disturbance environment is needed. A cursory analysis 
of the problem Is given In Appendix A, 

One other deduction can be made based on the analysis stemming from 
the model (4,15) - the extended Kalman filter Is superfluous at this magnitude 
of charge. This follows from the observation that the extended Kalman filter 
requires a dither acceleration of Iji/sec^, while the acceleration due to the 
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quadratic term in chorgo is 


1 ^^ 


< X0“^n/aoc^ 


Thus according to previous arguments, neglecting the quadratic term will 
contribute less than 1% error in the estimate. And discarding this term 
is equivalent to replacing the extended Kalman filter with a Kalman-Bucy 
filter. 

All of the analysis above pertains to the case where q » lO”^^ coulombs. 

The situation changes significantly for increasing charge levels. This is 

due to the tightening of the error requirement (4.12). Whereas an 18% error 

la tolerable at 10“^^ coulombs, the requirement drops to .18% at lO"^® coulombs. 

No simulation achieved this level of performance. Simulation 13 

stayed within an approximate .3% band of the actual value, while simulations 

14 and 15 were in a 1% - 2% range. Using a ranking system that is equivalent 

-11 

to the rankings for the simulations run at 10 coulombs, we find that 
simulation 13 is a marginal '*B", and simulations 14 and 15 are unequivocal 
'•C*'‘s. 

One noteworthy aspect of these simulations is that the terminal 
variances were in the same range as the variances in the previous simulations. 
Thus there was 3-4 orders of magnitude decrease from the Initial variance. 

This is not entirely surprising since we had earlier anticipated the stability 
of the filter, which implies that the initial statistics are forgotten. 

An extremely important element in all the simulations was the 
assumption of perfect knowledge of the voltage. Errors in this knowledge 
propagate two types of disturbance compensation errors. First, a bias in 
the estimate of the voltage will yield a proportional error in the charge 
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oRtJmntii. Ab wo linvc Boon with InrronRlnR chixrp,^ yalnon, thin typo of orror 
ran quickly hocomc cllnantrouB . The n«'cond typo of error, that proBouta a 
potontlally creator problem, In the actual S/fi trajectory error Introduced 
by the v2 term. RocalllnR that we have cBBentlally net a requirement of 
V “ 1000 volts to Identify the charRC, the acceleration due to this 
potential is 

lo y2 [2L - jP—— 1 (4.5 X 10“^) * 8.6 x lO'V/sec (4.16) 

mb ‘ R 

Thus to ensure an error of less than, 10 ^m/sec we need 

Iv - vl = 10 "\ . (4.17) 

Integral control can compensate for this error to some extent. But needless- 
to-say, a closer look at this problem will be necessary. 

V . INTEGRAL CONTROL 

A. Rationale for Integral Control Disturbance Reduction 

During close encounter, solar pressure will be the dominant non- 
gravltational force acting on the spacecraft. Furthermore, since the space- 
craft is nadir pointed, the solar pressure will be in a constant direction 
in spacecraft coordinates. As a result, the translation control system 
will be operating in a nearly single-sided limit cycle along the z axis. 

A proportional control system (the continuous approximation of the 
on-off control system) acting on the second order spacecraft dynamics in the 
presence of a constant disturbance will produce a constant proof mass position 
offset. Consequently, the proof mass will spend a larger portion of its time 

on the -z axis than It will on the -fz axis. 

Any mechanism for producing a proof mass disturbance due to a 

constant proof mass offset will thus be enabled through the critical 
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perihelion passage. Proof mass charge and self "gravity are two such 
mechanisms . 

There exist several methods for minimizing proof mass disturbances 
due to charge and self -gravity , Since some proof mass disturbances result 
from the proof mass not being centered in the cavity, one approach is to 
reduce the proof mass travel range by "tightening" the drag-free control 
system. In theory, this may be accomplished by expending a great deal more 
control fuel. 

A second approach is to permit larger excursions of the proof mass 
while monitoring both the proof mass charge, and the vehicle mass distribution. 
This allows for real time computation of the proof mass disturbances, effects 
which can then be included in the drag -free trajectory estimation. However, 
a difficulty arises in trying to monitor the proof mass charge. 

The charge "identification" procedure requires some type of proof 
mass rorced vibration or dither; the larger the response of the proof mass 
to the known dither , the greater the proof mass charge , In order to make 
the proof mass response visible to the existing proof mass sensor system, a 

sizable force must be applied to the proof mass. Although this force is 

•known," the relative precision to which it must be known Increases as the 

* 

magnitude of the identification force Increases, The accuracy to which the 
adverse effects of the charge identification procedure can be removed will 
depend upon the applied force knowledge. 

Integral control is the traditional appoach to minimizing the 
effects of constant disturbances. As applied to drag-free control, a very 
low bandwidth Integral control term can be added to the present drag-free 
control scheme. Because the integral effect is low bandwidth, there will be 
very little interaction with the basic drag-free control dynamics. The 
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lntcp,rrt.l term will keep the proof moHH at the center of the cavity the 
overag e . rather than slightly biased, os a proportional system would do. 

Very little additional control fuel should be required for this scheme, and, 
additionally, the proof mass la not disturbed. There Is also some degree of 
adaptability to an unknown magnitude of solar pressure force. The modifica- 
tion of the single-sided drag-free control law using Integral control will 
be the topic of the next section. 

It should be noted that In theory t^ levels of Integral control are 
required to eliminate the proof mass disturbance due to charge. The proof 
mass disturbance force Is, to first order, proportional to the proof mass 
position. Therefore double Integral control of the proof mass position Is 
the control that will produce zero proof mass trajectory error. Double 
Integral control Is a topic for future study. 

B, Integral Control Model 

Near the sun, the external disturbance environment is accurately 
described by a constant force due to solar pressure, in addition to a 
small random component. As a result, a single— sided limit cycle is appro- 
priate for control purposes. In this limit cycle, the thrusters are 
essentially firing occasionally to negate the effects of the opposing solar 
pressure drag. A phase plane plot of the single- sided limit cycle is shown 
in Figure 5.1, 

In other words, after the proof mass motion relative to the 
spacecraft has accumulated a net positive velocity, and is In the positive 
X direction (A), the thruster fires. The thruster eventually reverses the 
proof mass velocity (B) , and the proof mass I egins to drift In the negative 
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Figure 5. Phase Plane Plot of Single-Sided Limit Cycle. 

x-direction. The relative speed of the proof mass is gradually reduced by 
the solar pressure until it reaches its maximum negative excursion (C) , and 
then, the solar pressure further accelerates the proof mass back to A. 

Maximum use of the proof mass housing size can be realized by making 
the maximum positive excursion, x"^, and the maximum negative excursion, x , 
equal in magnitude, and as large as possible without allowing the proof 
mass to touch the housing. As might be expected, however, the maximum 
negative excursion (C) is highly dependent upon the magnitude of the 
solar pressure at a particular point In orbit, and is not likely to be well 
known a priori. Even if this problem could be circumvented, there is yet 
an additional problem. For the case where x^ and x“ are equal in magnitude, 
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the proof moos nvernge pooitlon in the limit cycle in not nt the center of 
the cavity (Juat an a bouncing ball'n average ponition in not nt 1/2 Ito 
maximum height). 

The modified control law Includes an integral control term. The 
purpose of this term is to keep track of the integrated position error, ond 
to adjust the thruster-off switch line to asymptotically reduce the integral 
of the proof mass position offset to some small bounded value. This scheme 
is adaptable to a wide range of disturbance environments, alters the single - 
sided limit cycle only slightly, uses roughly the same fuel. Is easy to 
Implement, and maintains the integral of the proof mass offset to a 
small level. 

The Integral controller is composed of two parts; first, a part 
that keeps track of the integral error, and second, logic that Incorporates 
the integral error Information in commanding the thrusters. The first compon- 
ent is easily constructed. Since a position measurement is already available 
from the proof mass sensor, a simple Integrator (amplifier, capacitor, 
resistor) is all that is required to keep track of the Integrated position 
offset. A discussion of what to do with this position integral information 
follows. 

The integral control to be added can be low bandwidth, since reducing 
the effects of charge and self -gravity requires the proof mass integral 
position error to be small "on the average." As such, the basic structure 
of the single-sided limit cycle will be retained, with corrections to account 
for the Integral error term being made only every few cycles. By keeping 
the thruster -on switch line as in Figure 5.1, it is fairly certain that the 
proof mass will never touch the positive wall. The technique behind the 
integral control action is to monitor the value of the Integral error once 
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per cycle, and to odjuat the thruater-off awltch line nllghtly ao aa to 
eventually bring the Integral error to the deaired value, 

Certoinly, the deaired Integrol error term can be choaen, and the 
current value of the integral error can be updated. The only additional 
piece of information needed to eventually achieve the desired integral error 
value is the average Integral error accumulated per cycle as a function of 
switch-off line value. This calculation is given below. 

Define the following parameters, 
is the value of the switch on line 
Sq la the value of the? switch off line 

T is the slope of the switch line 

is the magnitude of the control acceleration 
Aj is the magnitude of the disturbance acceleration, and 
X (x ) is the maximum positive (negative) proof mass position 


Since the position of the proof mass as a function of time is 
parabolic, the average position is given by 2/3 of the maximum value of 
the parabola. These values for the thruster-on and the thruster-off must 
then be weighted in proportion to the duration of the thruster-on and 
thruster-off times, respectively. It is easily shown that 


avg 


1/2 (S. + S„) + 1/6 ----- V 


Vg ■ + S„) - 1/6 






(5.1) 


and, the thruster on and thrustcr-off times are given by 
S,-S S,-S 

'P s — i — -j' B ^ Q 
on (A^-A^t ’ off AjT 


(5.2) 


44 


ThP nvorap.cd lutnp,rnl error accumulated per cycle, I, in 
then H Imply 


I ■ 


Ton ^ 


(5.3) 


After some algebra, the following result is obtained 

,2 


5,+s^ (S,-S)‘ r , ,*1 


(5.4) 


Solving for in terms of the desired value of the Integral error, 
1 . , and the current value of the Integral error, I, 


-B + /b^ - 4 * C * (sjc + Sj + 2(Ij-D) 


(5.5) 


where 


3t' 




2C 


3^ 

A. 


, and B “ 1-2 CSj^ 


Equation (5.5) shows that if a desired value of the integral error is given, 

and if the current value of the integral error is known, then the switch-off 

line S can be computed . 
o 

The "bandwidth" of the Integral control can be easily adjusted 
by correcting only a fractional change of 1 at each cycle (say 1/10) 
instead of the full value. 

C. Simulation and Discussion of Results 

A computer program was developed for simulating one dimensional 
proof mass motion In the housing using the single-sided ,imit cycle with 
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control, Tho vnluon of the parAmotorn chonon for one particular 

run were 


Sj^ ■ 3.1 nan 

Sq ■ 1,9 mm 

T " 0,20 sec 

Ag *3,3 mm/sec^ 

« 1 mm/sec 10 g (at least three times higher than the expected solar 

radiation effect) 

« -30 mm-sec 


The proof mass diameter was assumed to be 22 mm and the housing 
diameter was assumed to be 40 ram* Also^ a random acceleration component 
of 0,05 mm/sec with a correlation time of 0,1 sec was assumed to be 
present. The results of the simulation for 260 cycles (about 1895 sec) 
yielded 


X 

x’ 


max 


min 


" 6,479 mm 

“ -6,605 mm 

“ +8, 213 mm sec 

“ -43,709 mm sec 


fuel usage “ 2740 mm/sec (equivalent velocity increment)' 


These results indicate that the integral controller performed 
quite well. The maximum positive and negative excursions of the proof mass 
were roughly symmetric with respect to the cavity center, used a substantial 
portion of the cavity space, and were still bounded well away from the 
cavity walls. 

The Integral error remained bounded (rather than growing indefinitely 
without the integral control term) within a very small range. Note that a 
44 mm-sec position Integral error over the 1900 sec simulation time 


t. M% 


A6 


corroopondfl to an average proof maoR poaltion of 4A min-«oc/.l900 aec or 0,023 mm 
from the cavity centerl Thla la the benefit of the integral control term. 

The total velocity increment applied to the apacccraft by the con atant aolnr 
pressure term was 1895 mm/sec. It should be noted that no additional control 
fuel was required to compensate for the random component of the solar pressure 
model » while at the same time, performing the drag free control function with 
integral control. 

For a 1,000 kg spacecraft, the mass of hydrazine propellent required in the 

-4 

1/2 hour period is approximately 1,5 kg using an value of 10 g. 

VI. KEY CONCLUSIONS AND FUTURE STUDIES 

The preceding sections have provided discussions of the major areas 
Investigated in the on-board estimation and control synthesis of a drag- 
free system for the Starprobe Mission and Spacecraft. These studies, along 
with the supporting appendices and references, have taken a major step towards 
the system definition and understanding of functional requirements. 

Analysis techniques and simulation programs have been developed to 
explore Important Issues identified in earlier feasibility studies [4,5,6], 

The basic attitude and translation control system topology has been expanded 
to a full six degree-of -freedom simulation framework with dynamical and 
environmental cross-coupling linkages. Translation state estimation and 
proof mass charge estimation have been analytically developed, and parameter 
constraints have been identified and quantified. An integral-error control 
technique has been applied to the problem of identifying and measuring 
proof mass disturbances . This should provide a particularly important 
complement to the charge estimation approach, in that integral error control 
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can reduce the ol fecta of chnrp,l.nR on fcho proof mnan trajnetory ronultlnR 
from trnnalntlon limit -cyclo non^oymmotry durlnp, nolar oncountor. 

The nonBltivlty of tho proof mnan trnnnlntlon state oatlmator to 

angular rates and accelerations of tho spacecraft woe dctormlnod for a 

simulated 5 degree yaw turn (or Imaging slew). Simulating tho 0,1 dogroe/sec 

slew revealed that the acceleration due to the kinemotics with a centcr-of-mass 

2 

offset of 10 cm from the cavity center is less than 0,01 mm/sec . This 
magnitude was shown to have little Impact on the filter performance; therefore, 
the reaction wheel controlled angular rate and acceleration terms may be 
deleted in the filter design. The major benefit of this is to allow a 
decoupled estimator with steady state gains to be realized - a most Important 
asset for on-board implementation. 

In the charge estimator synthesis a set of rather specific constraints 
have been found within which the estimator performs at an acceptable level of 
accuracy and convergence. These parameter constraints are: 

-11 

(1) A proof mass charge magnitude in the range of 10 coulombs, 

or less. 

(2) Capacitive plate potentials of 1 Kv. 

(3) An identification dither frequency sufficiently removed from 
disturbance frequencies, yet low enough to ensure visibility to the proof 
mass displacement sensor, l.e., 5 Hz or less for sensor visibility. 

(A) A proof mass displacement sensor resolution of 5 microns 
(0,005 ram) , 

The analysis has established filter sensitivity to unmodoled/ 
mismodeled disturbances. We would expect that as a better disturbance 
model develops some of the above constraints might be relaxed. In particular. 
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If An ImprovAd i.odt.1 nUown Cnr a dncrAAAA In dithnr CtAquAncy thon n lonor 

voltrtRO or n noloior nnnnor luoy bo tnloratocli 

Within thono conntrnlntn tho UkoUhoocl hnn omorRO.l tlmt n Knlmmi" 

Bucy filter would be nn effective nn the extended Knlm/m filter for o.hnrp,e 
ootimntlon. The clear advuntaRu of the Kalmnn-Bucy form io the olmplieluy 
of precomputed Bulno, thuB maklns It amenable to on-board Impltimentation. 

While the accompliahraentH of the work to date are uiBnlflcuut there 
remains a considerable task ahead in the areas of requirements definition 
and system analysis. A brief discussion of these future study needs and a 
realistic perspective on the critical issues is given in what follows* 

Although the Integral control concept has been investigated with a 
single axis model and found to be quite promising, a three-axis development 
is needed , There are several issues that need to be studied before a 
complete controller can be properly specified and designed. An important 
question to address is how should the control technique for the transverse 
(X and Y axea) differ from the longitudinal (Z) axis since it is unlikely 
that transverse limit cycles will be single sided like the Z axis. Heat 
shield asymmetries, thermal warping, and laon-nadir pointing/perturbations 
will give rise to transverse axis disturbances very difficult to predict. 
Since the signatures of these forces cannot be adequately known (magnitude 
and spectral characteristics) , the translation controller must be insensitive 

to such disturbances. 

Another critical area is the compatibility of the charge identifi- 
cation method with the realistic constraints of the translation controller 
and device/model errors. The charge identification scheme Invokes the arti- 
ficial acceleration of the proof mass in order to identify the charge 
disturbance. A major concern is that the Identification accelerations are 
3 to 5 orders of magnitude greater than the one we wish to measure. 


49 


Obvlouflly, wo cannot proceed to implement the identification filter without 
a comprohonnivo analyain of ita impacte on the Roneral draR^froe doalRn and 
ita banlc viability, Thia effort meat include aonaitivity to chatRO model 
errora, plate potential orrora, the impact of intoRral control in reducing 
theae orrora, tranalntion control otnbllity conotrolntn on Idontlftcotion 
froquoncioa and aeeoioratlena , and the foaolbllity of active charge removal 
during clooe encounter, i,e,, intermittent proof mnao grounding. 

A methodology must be developed for the translation controller 
parameter (a) definition and selection. Techniques for bandwidth and gain 
setting with adaptability uo a wide range of time-varying conditions during 
encounter must be found which provide autonomous control stability and optimum 
performance of the integral-error loops. This control technology must not 
rely on the assumption of well known error and disturbance models; it must 
instead employ predict/observe/correct logic to obtain In-situ high precision 
while protecting against out-of-limlt conditions. 

In the future as the Starprobe simulation programs continue to be 
used for both systems level and component level evaluation better models 
of the near solar environment, the spacecraft configuration, and the multi- 
experiment dynamic scenarios will be needed. More specific descriptions of 
these areas are necessary in order for control system requirements to be 
completely defined. With these specifications, the programs can be used to 
evaluate the proposed hardware and software adequacy. In this way theae 
computer tools serve in every phase of the control system analysis, design, 
and verification. Expansion of the simulatinn programs to encompass all 
the interactive elements of the spacecraft will also be a parallel task as 
the aforementioned definition evolves. 
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APPENDIX A 
DISTURBANCE EFFECTS 

A partial list o£ forcoa contributing to model errors Includes 
8 lar pressure, control forces, kinematic effects due to the accelerated 
S/C fixed frame, moving masses, and self-gravity . Below we give a brief 
analysis of each of these forces and their relative Impact on the charge 
identification problem. 

The solar pressure is a slowly varying parameter, and its variation 
over 500 seconds is negligible. If a perfectly symmetrical S/C remained 
exactly nadir pointed, a very precise estimate of the acceleration resulting 
from the solar pressure might be attained, (This would be somewhat analogous 

5 

to estimating the charge with 10 V.) What is not certain is the variation 

in this acceleration as a function of S/C attitude and non-symmetries. This 
is design dependent and merits further analysis. 

Errors introduced by thruster mismodeling are, at worst, transient 
since these errors only occur while the thrusters are on. This source of 
error can be circumvented by not updating the charge estimate at these 
times . 

Kinematic and moving mass effects are also design dependent, and 
it remains to determine whether these terras need to be incorporated into 
the charge estimator. We can however state with certainty that they 
present no problem. The reason for this follows. 

The total disturbance created by these effects is 

p -f 2(1) X (p-r) -f (i)x(p-r) + u)x((ox(p-r)) (A-1) 

Based on the torque and momentum storage available from the reaction 

•“3 ““S 

wheels, upper bounds of 3 x 10~ rad/sec and 3 x 10~ rad/sec2 can be 
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placed on w and (i rcapoctlvely . We remark that theao maRnitudea con only 
be attained while the 8/C la executing an imaginp, alow and in general would 
be an order of magnitude less. Now p appeara as a result of a reaction 
force from translating or rotating a mass (antenna, platform, etc.) Such 
forces would not exceed a few thousandths of a newton } and from the drag- 
free control law we obtain a bound of 1,5 mm/sec on |r|. Putting these 
considerations together and allowing for a 10 cm offset in the center of mass, 
as a worst case (A-1) is in the lOy/sec^ range. In such an event Incorporation 
of these terms would become necessary. This is the magnitude of the unmodeled 
disturbance used in the charge estimation simulations. 

For estimation purposes the pertinent question is how good is our 

knowledge of these disturbances? In Appendix B it is shown that even in 

2 

the worst case these accelerations can be modeled to within .Sy/sec , 

••2 2 

Self -gravity accelerations are in the 10 y/sec range and there- 
fore have negligible impact on the charge estimation problem. 

Strong Electrostatic Charging 

We have already noted the Impact of increasing charge levels on the 
identification problem. A recent study [7] has shown a remote but finite 
possibility that the charge on the proof mass may exceed 10 coulombs in the 
solar encounter. It behooves us to indicate the severity of the problems 
associated with much greater magnitudes and suggest possible solutions. 

These extreme levels apply to the case of an "extraordinary*' solar flare 
incident, and the Jovian environment in general. 

To illustrate the control problem due to very strong charge we 
take the value q = lO"^ coulomb; then from (4.11) the acceleration due to 
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this charge is calculated to be 

|r I s 68 X Ir^jl/aec^ . 

e mb'*R 
o 

Therefore If the proof mass is displaced 1.0 mm from the cavity center, the 
acceleration above la ^ times that of maximum solar pressure during sun 
encounter. Consequently there would not be sufficient translation control 
authority to return the proof mass to the cavity center. However, there are 
some parameters that can be adjusted to diminish the charge effect. For 
example, increasing the mass (m) of the proof mass will linearly decrease 
the charge acceleration, and an Increase in the cavity radius b (with a 
proportional increase in the proof mass radius) will result in a cub^ decrease 
of the acceleration. Thus modifying the proof mass-cavity configuration 
is a possible method for restoring the robustness of the controller. 

Another approach would be to narrow the deadband. But this offers only linear 
improvement and results in a higher bandwidth controller. 

For the sake of argument , let us assume that the control problem 
has been overcome by some combination of the remedies offered above. We 
still must confront the charge problem. Suppose both the cavity radius and 
the proof sphere's mass were increased an order of magnitude. This would 
yield a decrease in the charge acceleration of 4 orders of magnitude. Even 
with this new geometry, a submicron displacement of the proof mass would 
result in an acceleration greater than the drag-free objective of lO"^ m/sec^. 

It is evident then that any controller approach to reduce charge effects is 
inadequate, and a charge identification is still necessary. 

Staying with this new configuration, the error criterion (4.12) becomes 


net rnnsidered how geometry modifications Impact sensor resolution. 


I* 
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A proof mono dlRPlao.on.ont of 1.0 nnn wou.ld than roqulro bottnt than 1 part 
In 10* accuracy In tho charBo oatlmate ... guarantee a I0‘*m/Boo^ error In 
the eatlmtcd aoooloratlon. Thla iB certainly far hotter than the I part 
in 10® required hy the old goametry, hut It la atlll unaooeptahly sevoto. 

In any case geometry "fiddling" iB at leaat Buggeatlve of diteotionB to 

pursue in this problem. 

Although the strong charge problem is indeed formidable, it would be 
premature to conclude that Ita aaaoclated difficulties are Inaurmountahle . He 
ace merely pointing out that »hlle the software methods (estimation, Integral 
control) developed In this report are effective In compensating/reducing 
disturbances 1 or 2 orders of magnitude, a more design Integrated strategy Is 
necessary for this extreme problem. This would include Investigation of varlou. 
sensor geometries, greater shielding of the cavity, discharging of the proof 
mass, ultra-high resolution displacement sensing, etc., to bring the charge 
into the range where integral control and the error compensation model 
approach are viable. 
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APPENDIX B 

PROOF MASS STATE ESTIMATOR DESIGN 


Without further analysis into tho charge identification scheme 's 
impact on tho drag free mission, we feel that it is appropriate at this 
time to consider the charge as an intermittently estimated state. With 
this in mind we construct two estimators. 

The sole purpose of the first estimator is to provide knowledge 
of the proof mass position and velocity. As was demonstrated in the 
simulations of Section III, there is negligible gain in including angular 
rate and acceleration Information in this filter design. Therefore we 
may ignore these terms and decouple the estimator (3.2). The resulting 
steady state filter for the z-axls Is 
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(B.l) 


with = 2, k2 ® 2, The filters for the other axes are obtained by sub- 
stitution of the appropriate subscripts in (B.l). 

In contrast with the filter above, the analysis in Appendix A 
suggests the need for retaining the angular rate, angular acceleration, 
and center of mass posit ion/mot ion Information in the charge estimator 
design. It is conceivable to incorporate these terms into the state of the 
charge estimator, but a reasonable consideration for on-board implementation 
of the filter Is to avoid Introducing additional states when possible. 

Thus we shall consider them as previously estimated inputs to the estimator. 
The filter equations (4.9) then become 
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and P “ (Pjj) satisfies (4,9b). 
ij 

In the interest of maintaining the decoupled nature of the filter, 
in the equations above we take r and r to be estimates supplied by the first 
filter. The alternative to this would be to incorporate these terms into 
a filter based on the original dynamics (4,1). But then a.7 x 7 covariance 
equation would result instead of the 3 x 3 as in (4,9b), Therefore this 
slight alteration eliminates the need for solving 22 coupled differential 

equations ! 

We remark that these filter equations represent a worst case In 
that it may not be necessary to Include all the dynamic and kinematic 
terms. For example, taking an objective of modeling these disturbances 
to within ,ly/sec^, the second order angular rate terms would not have to 
be modeled if the center of mass remained within 1 cm of the cavity center. 
In any event, we proceed to develop estimates of these terms below. 

We first consider estimating o)^ and (the extension to the 
other axes will be obvious). Let 1^^^, and denote the S/C s 

moments of inertia, and let T^^ denote the component of the torque vector 
along the x-axis. Assuming 1 (lyy “ small products of 

inertia, the situation is characterized by the dynamics 
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w ■ T /l 
X xx' XX 

and the observations 


(B.4) 


A 0 e 
*^1 


(B.5) 


where y is the gyro output - an incremental position vector, 

"^l 

^®t * At » , and Is an error, 

i 1 

For |<i)| < 5 X 10 ^ rad/sec^ and jp| < 1 cm, the contribution of 
the term [wxCp-r)]^^ to the total disturbance is less than .OSp/sec^. 

Assuming the attitude control authority is an order of magnitude greater 
than the disturbance torques, the assumption on |t | is valid when u 
warrants consideration in the filter design. Thus by defining w ■ T /I , 

X X XX 

^ A 

where is the feed forward control torque and I is an estimate of I 

XX XX 

obtained by say calibration, the estimate error here is 
l“x - i - V^xxl 

iVVxx l^xx -ixxl + I^X -\l 

XX 

Then 10% errors in the estimates of T and I „ would then yield about a 20% 

X XX 

error in the estimate of w . Using lul < 3 x lO"^ rad/sec^, we obtain 

^ luclX 

l^x ” “xl 6 ^ rad/sec^. 

The easiest approach for obtaining to is to form the quotient 

2\ 

y /At, The error Incurred here is 


I e /At I 4 - max 




te[ti_i,t^] 


<_ |e |/At + At |to (t) 

Cf X 


max 
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TaklnR At .01 noc, < 3 x rad/ncc^, nnd |e^| < lO”^ rod 

(5.02 (Qj), tho orror nbovo is then bounded by 10 rnd/soc. 

Now wc turn to the quoatlon of ostimating the center of mass and 
ito derivatives in the presence of moving masses. The focus hero is on 
moving platforms and appendages rather than tho "slow” effects of fuel 
depletion and thermal distortion. 

To obtain these estimates we decompose the S/C Into two components. 


M, 


p(a) 

I 

“2 

-X 

1 

^rua; 


Cavity Center 


Here M 2 represents a mc'ving mass (m 2 “ its mass) , Mj^ represents the remainder 
of the S/C (mj^ ® its mass) , h(a) the center of mass of M 2 (a is a measured 
parameter from which h(a) is known), n the center of mass of Mj^, and p(a) 
the center of mass of the S/C. Then clearly 


p(a) 


m. 


™1 ^ ™2 


n + 


mj^ + m2 


h(a) 


(B.6) 


From (B.6) we obtain the derivatives with respect to the S/C frame; 

• » ^-”*1 h*(a)a. ? - th’(a)a+h»(a)i2l . 

Since h(a) is known from the geometry and measurement of a, it remains to 
• ** 

determine < and a. But these are readily obtained from the force acting 

on Mo. Let F denote this force. Then. 

2 o 


r n 
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— K- (p(«) - h(«)) P„/nio 
dt^ « ^ 


Now recalling (B»6) 


j2 fli« uIa 

2 - 5 - (h(a) - n) ■= P, 

djZ m2 c 


(B.7) 


(B.8) 


And in S/C coordinates (B.8) becomes 

ah ’ (o)+o^h*' (a)+2awxh * (a)+wx (h(a) -n)+wx (wx (h (o) -n) ) 


"1 **2 r 

m^^ m 2 a 


(B.9) 


This equation Is not as bad. as it looks. For example, If h(a) 
represents a translation, say h(o) “ az, z ■ unit vector, a » displacement, 
then h"(a) "0, Furthermore, under our present assumptions on |(t)| |w| 
etc,, (B,9) effectively reduces to 

•• “1 “2 . , 

a = -± i F 

mj^ m 2 'o' 

And from this it follows that 


F 


m. 


As precise knowledge of both the actuator force and the mass 

of the moving appendage or platform is expected, the error in the estimates 

* •• 

of p and p will be driven by the error in the S/C mass estimate. 

In any case, with the estimation schemes outlined above, the total 

model error contribution of the kinematic and moving mass effects can 

2 

probably be kept below ,5u/sec . 
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APPENDIX C 


PROGRAM 


STAR PROBE BPACEPRAFT SIMULATION 

THREE AXES STABILIZED RIGID BODY CONTROL 

I9S1 CONICAL SHAPE CONFIGURATION 

FULL SCIENCE OPTION WITH 30 DEG HEAT SHIELD 

RETRACTED HIGH GAIN ANTENNA 

CONDITIONS AT PERIHELION 


COMMENT CREATED 01 MAY 19S1 BY R.W. KEY 
METRIC UNITS THROUGHOUT (N-M-8> 

MASS PROPERTIES FROM D. NOON <JUN Sl> 

DRAG FREE ESTIMATOR DESIGN BY M. MILMAN <MAY Oi) 

DRAG FREE CONTROLLER DESIGN BY D, SCHAECHTER 
HYDRAZINE GAS TET CONTROLLER DESIGN BY P. MAC <JULY SO) 


I NTEGER T , K , MANNER , T J , JP 1 , JPS , JP 9 
ARRAY SCCMLU(3) , GJCLU<A>3) 

FSC<3) > TSC<3> 


CMTGJU(4,3> ^ CPLU<3) 

FGJ‘<3) > TGJC<4,3) 


, GJFU<16,3) 
> CMTCPU(3> 

, JI:!;T0N<16> 


, SCINRTIA) 
, PMCCLUO) 
, FCJC(4,3> 


> • * • 
> * • * 
> ’ ‘ * 


DROP 

COMMENT )|t)|()K)|()|<>l<#)K)l<H<>K)|(i|t5{of<HoH)|ii)K>iOK#>K)K5K>K)!oK>K)|t!|oK>K)KHoloK)K>KHoK>KH<>lo|OKJ«HoK#)|oloKJl<H<)K#)|oK#)K5K* 

COMMENT )|c)|i:)|<i|0K*)K>l0H>K)«*>K>K!|0K>i<#)l<>K S/C MASS PROPERTIES 

COMMENT 


DATA SCINRT/47S0. 0,4700.0,1700 . 0 , 0 . 0 , 0 , 0 , 0 . 0/ 


COMMENT S/C CM LOCATION UECTDR 


IN CAVITY COORDINATES 


DATA SCCMLV /-^O . 0 0 , +0 .00, +0 .00/ 


COMMENT H<!|f!|t>K)|{#)|tHo|olt)KHo|oK>K)K5K>K)f<)loX)(oKH<*>KHo|oK>K>K>K>lo|ol<!KHO|oK)|o|{Ho|o|oKi|o|{*>K#!lcHo|{*#)l«*!l<*)K)KiK# 
COMMENT HOK*#** LOCATION OF GAS TET CLUSTERS .IN CAVITY COORDINATES 
COMMENT >K)K)|t>K)|tH'vH<>K*H<HoMK>loKH<5|o|o!<HOK)K>K>K!|o|oto!<5H>K>K>K)KH<)|oi<)X)(<*>K*H<)K>K>K!K>K#>K**H(H<)K5|OKiK>K#5K#Ht>K 


DATA < G JCL V ( 1 , J > , 1,3) /•♦■ 2 . 0 , 0 . 0 , 0 . 0 / 

DATA <GTCLV(2,J),J“»i,3) / 0 . 0 , +2 , 0 , »0 . 0/ 
DATA <GJCLV(3,J),J«i,3) /"2.0, 0.0,40.0/ 
DATA ( G JCLV < 4 , J > , 0 1,3) / 0.0, - 2 .0,40. 0 / 


COMMENT >|()K)X!ji:)KH(Ho|tHOK VECTORS FROM S/C CM 


TO GAS TET CLUSTERS 




DO Li K«l,4 
DO LI J««l,3 

CMTGJ V ( K , J > “-C-MCLV ( l< , J ) • SCCMLV ( J ) 
Li.. CONTINUE 

COMMENT 

NX«INT>^M) . 


PICKUP 

INITIAL 

CONSTANT PIE»=‘3.i415926S , G=9.B066S 


M/NiP t?ft ft/irrni 
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COMMENT 


* 

»K 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 


l)EF:i:iM(;i; the B/C FXXEP AXEB AB FCILLOWB: 


I» »n» ftif t»it »**t II* t H*| >m tn« 


X «« HGA DEPLOYMENT PJIRIECTION 

Y »" DEXTRAL COMPUEMliL'NT 

7. m heat BHXIi'LD AXIS OF SYMMETRY 

ORXGXN ;i:b centixr of proof mass cavity 


IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

iK 

IK 

IK 


)KiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKlKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiK>KiKiK}KiKiKiKiKiK!KiKiK»iKiK$)K 


iKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKHoKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiK 


)K 

IK 

IK 

IK 

IK 

IK 

)K 

IK 

iK 

iK 

IK 

IK 

IK 

IK 


SELECT THE MANEUVER BY ITS NUMBER 


4 MW l*l« 


1 

2 

3 

4 


b 


TURN ENTIRE SPACECRAFT ABOUT X AXIS 
TURN ENTIRE SPACECRAFT ABOUT Y AXIS 
TURN ENTIRE SPACECRAFT ABOUT Z AXIS 
ACQUISITION OF INERTIAL REFERENCES 
SOLAR FLYBY (PERIHELION) 


IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

« 

iK 

* 

IK 


iKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKlKiKlKiKlKlKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiK 
IK ^ 

IK » 

CONSTANT MANEUV S . 0 

COMMENT iK ♦ 

iK ^ 

♦iKiKiKiKiKiKiKiKiKiKlKiKlKiKiKiKiKiKiKiKiKiKiKiKiKiKlKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiK 


iKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiMKiKiKiKiKiKiKiKiKiKiKiK 


IK 

IK 

IK 

IK 

IK 

iK 

IK 

IK 

IK 

IK 

IK 


CONSTANT 


DRAG FREE TRAJECTORY INFORMATION 


HELIOCENTRIC COORDINATE REFERENCE FRAME 
i AU i.AVAOE-fli (M> 

SOLAR RADIUS « 0.0046S24 <AU) 

PERIHELION ALTITUDE <AU> 

PER AL T O.OiSAi 


IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

iK 


iKlKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKiKtiKiKiKiKiKiKiK*^ 
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w ii^ ti/ ^ ^ y# y/ ^ iii' tv ^ y^ y^ ik y^ y/ iii y^ ^ y^ y^ y/ ^ y/ y/ y/ sv ^ y^ y/ ^ y# y<^ y/ yt* y^ ^ y/ y/ y/ y/ y^ t/t* y^ 


» 

)K 

W 

IK 

« 

IK 

IK 

COMMENT IK 
IK 

IK 

CONSTANT 
COMMENT IK 
IK 

CONSTANT 
COMMENT IK 
IK 


SET PROOF MASS .TNITIIiAl CONDITIKONS 

ttti *m ew mi «*t mt «« w> nw tnt iitt mi i« mi mi im «• »* itit im tm mt tm itii mi ini mi mi im im mt mi mi 

X AXIS Y AXIS Z AXIS 


mi im im mm mi im 


PROOF MASS INITIAL VELOCITY < M/SEC > 

PMXDI'H'O.O , PMYDI>*«0,0 > PM2:i>l««0 . 0 

PROOF MASS INITIAL TRAJECTORY POSITION <M> 
PMXI««0.() , PMYI«iO.O , PMEI--0.0 


IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 

IK 


tL>u>(ijUi*i»d>ti««i>%i^ui>y^u»y^4L>u^tbioy^^y/y/y/ii/y^ioy#y/yiiUi»%L>y/y/t^yi*yt>iify^y/y/y^y/y^y/y*wy/y>y/yi*ifeyi^y^y/yi^y/yfy^ 


)K)KlKiKiK)KlKiKiKiKlKiK)KlK)K)KlKlKiKlK)KiKlKiKlKlKlKlKlK}K!KiK)K)KiKiKlK)K}KiKiKiKiKiKlKlK)KiK)KlK)KiK)K)KHOKiK 
IK 

IK SET SPACECRAFT INITIAL CONDITIONS 

♦ 

)K X AXIS Y AXIS Z AXIS 


IK 

IK INITIAL ANGULAR RATES (RAD/SEC) 

IK 

CONSTANT WXI«'0.0 ^ WYI>»l.liE”4 , W2I'«<0.0 

COMMENT iK * 

IK INITIAL ANGULAR POSITION <RAD) » 

)K IK 

CONSTANT THETXI««0.0 , THETYI-^O.O , THETZI^O.O 

COMMENT IK * 

IK INITIAL TRANSLATIONAL RATES (M/SEC) * 

)K iK 

CONSTANT SCX»l«0,() > SCYDI»'0.0 , SCZDI-0.0 

COMMENT IK ♦ 

IK INITIAL TRANSLATIONAL POSITION <M> * 

IK IK 

CONSTANT SCXI»0.0 0 , SCYI«0.0 0 , SC2l«'+0 . 00£>S 

COMMENT ♦ ♦ 

IK IK 


^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k ^k 
rf^ 
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< »t' [;'!■ *' 'I “."'f I li'l''' 


^ $ 
>K TURN COMHAND INFORM AT I' ON A 


A NAI>:i.R POINTING TURN RATF GOMMANDIi) 

$ 

CDN8TANT NADIRXn»0 , 0 , NADIR Y""! , , NADIR3'-"-0 . 0 

COMMENT A 
$ 

A COMMANDED BPACECRAFT TURN RATE8 <RAD/I3EC> 


CONSTANT 
CONSTANT 
COMMENT A 
A 


TRNTIM »" 0.00 

TRNXRT»»i . 745E'»:5 , TRNYRT™! . '/^SE-rS , TRNZRT“«i . 74SE-:" 


aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa 


AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 
^ A 

A CONTROL SYSTEM ON/OFF SW-ITCHS A 


CONSTANT TC80N«1 . 0 

COMMENT A 

A DRAG FREE 


ACSONa«l . 0 


CONJTANT 
COMMENT A 
A 


DFON>»i . 0 


CAS J’ETS 
GTON«‘0 . 0 


REACTION WHEELS 
RWON «<1.0 


AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 


AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

^ A 

A SET SIMULATMON TIME A 

A 

CONSTANT FINTIM la 9.999 , SIMTIM «' S.OO 

COMMENT A ^ 

AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

TRNXON'aO.O A TRNYONa'O . 0 $ TRNZON«<0 . 0 

MANNBR*aMANEUV-*- . B $ CO TO <Ml,M?i>.M3.M4>MB) > MANNBR 
Ml . . TRNXONa.1 . 0 A CO TO MEND 

M2.. TRNYONail.O $ 00 TO MEND 

M3.. TRNZON»1.0 $ GO TO MEND 

M4. . TCSON »o.O $ GO TO MEND 

MB.. CONTINUE 
MEND. .cont;i;nue 
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COMMENT 

COMMENT 

COMMENT 


COMMENT 

COMMENT 

COMMENT 

CONSTANT 

CONSTANT 

CONSTANT 

CONSTANT 


».***»*»**«,»«, 

TRWMAX«1.(MI « COMMENT MAXIMUM REflCTIDN WHEEL TORflUE CAPABIUTT 

*****»*.»»*, ****»*H,;*i»**»»„„***„jjj"jjj^^ 


CA8USE««0. 0 
GTMOT « 0.010 
ISP w tis.o 
FIJET^O. 4A48 
CANTW62. 0J<cPIE/i80 . 0 
FCJSwElJET)KS.tN<CANT) 
FCJC-^FITET^COSCCANT) 
CMFLOW««FlJl»T/asp)KC) 


COMMENT ;i'n,tt;i:uze gas used 

COMMENT CAS JET MINIMUM ON TIME 
COMMENT SPECIFIC IMPULSE OF N2H4 
COMMENT FORCE OF ONE JET =« 0.1 IB 
COMMENT CANT ANGLE OF JETS 9 THRU 16 
COMMENT FORCE OF A CANTED JET 
COMMENT CANT ANCLE W.R.T. XY PLANE 


COMMENT DEFINE EACH GAS JET FORCE VECTOR 


GJFVa, 

GJFM<2, 

GJFV(3> 

GJFV<4> 

GJFV<S, 

GJFV<6, 

GJFV<7, 

GJFV<8, 

GJFV<9, 

GJFVao 

GJFVai 

GJFV<12 

GJFV(i3 

GJFV<14 

GJFVaS 

GJFV(16 


1 )«0 
I >«0 
1)«0 
i >«0 , 

1 )»0 , 

1 )«0 . 

1 )«0 , 
1 )« 0 . 

1 )«0 . 

> 1 )«0 . 0 

>1)«“-FCJC 

>l>«<-fFCJC 

>i>»0.0 

> D^^O . 0 

;l>«-fFCJC 

,1)*-FCJC 


.0 

0 

. 0 
0 
0 
0 
0 
0 
0 


♦ 

$ 


GJFVa, 

GJFV<a, 

GJFV<3; 

GJFV<4, 

GJFVCS, 

GJFV<6, 

GJFV<7, 

GJFV<8, 

GJFV<9, 

CJFVaO 

GJFVdl 

GJFV<12 

GJFV(i3 

GJFV<14 

GJFVdS 

GJFV<16 


^)»0 
2>'«0 , 
2)«*0 , 
2>«0 . 
2)«<0 , 
2)<«0 . 
2)»0 , 
2 >“0 . 


2)<«+FCJC 
>2)«-FCJC 
^2>«<0 . 0 
>2)<«0 . 0 
,2)«<“-FCJC 
>2)««-fFCJC 
,2)«<0 .0 
>2)«0 . 0 


$ 

$ 


GJFVd, 

GJFV(2, 

GJFV<3, 

GJFV<4, 

GJFV(5^ 

GJFV<6> 

GJFV(7^ 

GJFV<8» 

GJFV<9^ 

GJFVdO 

GJFVdi 

GJFVdS 

GJFV(13 

GJFVd4 

GJFVdB 

GJFVdS 


3!)*+F1J‘ET 
3)*+FiJET 
3)«*+Fl JET 
3)«-fFlJET 
3)<«+F.tJET 
3)*>‘fFlJET 
3).‘«+FiJET 
3)«»-FlJET 
3)w. -FCJS 
>3)*~FCJS 
>3)«~FCJS 


,3>«" 

;3)«- 

,3)«" 

,3)s- 

,3)<a" 


•FCJS 

FCJS 

■FCJS 

FCJS 

FCJS 


COMMENT 

COMMENT SET^EXECUTION INTERVAL FOR ATTITUDE CONTROL ALGORITHMS 


COMMENT BET EXECUTION INTERVAI, 
TCBlHQ-^Ct 


FOR TRANSLATION CONTROL ALGORITHMS 


COMMENT .INITIALIZE S/C TURN COMMAND INFORMATION 


TURNON««l . 0 


TRINCX=«TRNXR'nKACSINCiKTRNXON $ 
TRINCY'==TRNVRTi{CACBINC)KTRNYON $ 
TRINCZ>«TRNZRTJf(ACSINC)|tTRNZON f|s 
T R N(.;OX=--' 0.0 $ TR NCO Y = 1 , 0 0 45SE • 


NADIRX==NADIRX)|{ACSINC 
N A D I R y a«N AD I R Y >K AC B I N C 
NADIRZ«NADIRZ*ACSINC 
3 $ TRNCOZ«:0.0 
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COMMENT )K)»I!|OKHoK>IOK ATmUDE RATE •♦•POCmO.^ CONTROLLER PARAMETERB )K)«)K)|OK)toK)K)K 
COMMENT REACTION WHEEL CONTROL LOOP PARAMETER VAIJJEB 


CONSTANT RWKPTX ■’< U4.4 
CONBTANT RWKRPX 9,1.0 


RWKPTY »' 1.1, -1,6 
RWKRPY 9,06 


RWKPTZ »« 1.1. -1.6 
RWKRPZ B.1S 


COMMENT GAS JET CONTROL LOOP PARAMETER VALUES 


ACSDBsM) . 0S0)«P1'E/1.S0 . 0 U COMMENT GAS JET ACS OEAD BAND SIZE 
CONSTANT GJKRPX « 4,7Vi> , GJKRPY -1.70 , GJKRPZ i . 7 


COMMENT ATT.TTUDE RATE ESTIMATOR PARAMETER VALUES 


COMMENT ATESKX » 0.0 


ATESKY « 0,0 


ATESKZ 0.0 


COMMENT translation controller PARAMETERS *»>K)K}f<)K)|o|o|c*)|o|OK}K)|oK 


CONSTANT 

CONSTANT 

CONSTANT 

CONSTANT 

CONSTANT 


SCMASS«»i00 0 . 0 

TCSI)B«0.0 05 $ COMMENT TCS DEAD BAND SIZE 

2DBOr"F«-"0 . 0 0442 $ COMMENT Z DEAD BAND SWITCH OFI-" LINE 


DFKRPX «» O.S 
DFINKX « 0.0 
INTER X « 0.0 


DFKRPY “OS 
DFINKY «« 0.0 

INTERY =« 0.0 


COMMENT INITIALIZE POSITION INFOMATION FOR OBC 

SCXPMI«SCXI“PMXI $ SCYPMI-«SCYI-PMYI 
SCXESI-«SCXPMI $ SCYESI»«SCYPMI 


DFKRPZ 0.5 
DFINKZ «= 0.0 
INTERZ 0.0 


$ SCZPMI'-aSCZI-PMZI 
$ SCZESI>»SCZPMI 


SCXDPI««SCXDI“PMXDI<Ji SCYDPI«=SCYDI-PMYDI $ SCZDPI^SCZDI-PMZD I 


SCXDEI«*SCXDPI 


SCYDEla-SCYDPI 


COMMENT ESTIMATOR KNOWLEDGE OF THE S/C CM 

SCCMXE^SCCMLV ( 1. ) $ SCCMYE^SCCMLV ( 2) 

COMMENT DRAG FREE ESTIMATOR PARAMETER VALUES 


CONSTANT 

CONSTANT 

CONSTANT 

CONSTANT 


COMMENT 

COMMENT 

COMMENT 

CONSTANT 


R«»0 . 04 
P11.I=«.1. ,E-f2 
P44I«!3,E'4'2 
SGPX“.i0.Ef2 
ERX“*0 . 0 
ERXD=«0 . 0 


P22I«3.E+2 
PSSIi™i .E+2 
SGPYaiO .E»2 
ERY«>0.0 
ERYD«0 . 0 


SCZDEI«SCZDPI 


SCCMZE«SCCMLV(3) 


P33I««.l .E-fi? 

P 66 1=3 . E+2 
SGPZ»«1.0 ,E-*-2 
ERZ*0 . 0 
ERZD«0 . 0 


DISTURBANCE MODEL DATA 

DISTON « 1. ,0 ir. COMMENT ON/OFF SWITCH FOR DISTURBANCES 


TDisrx«o.oo 

FDISTX-^-O .00 


TDISTY--0 . 00 
FDISTY-O .00 


TDISTZ=0 . 00 
FDISTZ“0 . 00 
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COHHENT )K$!|0|0K)K)K)|»|0K)KH0(1)K>K*>I0K SOLAR RADIATION MODEL $>l<>l<)|<»)|<)tt>Ki|(il()|o|f*>|oK*»K)K)K#)K)K 

COMMENT SOLAR RADIATION FORCE EOUIVELENT TO IOE-5 "0" 

F8R'«SCMA8S>KG)K1. ,E-S « COMMENT RANDOM FSR MEAN VALUE 

FSRSIO'»FSR/10.0 $ COMMENT RANDOM FSR STANDARD DEVIATION 

FSRCTCoEiO.O in COMMENT RANDOM FSR CORRELATION TIME 

COMMENT proof mass charge identification disturbance 

CONSTANT PMMASS»0.2>0 Hv COMMENT PM MASS <KG) 

CONSTANT IDVOLT«1000.0 $ COMMENT PM CHARGE ID VOLTAGE- 

CONSTANT IDKa«2.4E-8 Hi COMMENT PM CHARGE ID CONSTANT 

COMMENT 

PZI>Pj.I,P2I,P 31 «*HCK (IN I TL ^ THETX I , THETY I , THETZI ) 

NXQDYN«0. $ NXC|DER<»0. $ NXGjTER»«0 . $ NXOINTwNXQINT^ l . 

END 

DYNAMIC 

VARIABLE T«0. 0 0 Hi TIME»<T«“SIMTIM $ IF<T.GT.FINTIM)GO TO FIN 
DEBUG T>1,0. 

DERPDY«>NXQDER““NXDERL Hi NXDERL««NXODER $ NXQDYN««NXODYN-f i . 
THETAX«2.0)KP1 $ THETAY««2 . 0*P2 $ THETAZ*«'2 . 0)KP3 


COMMENT | 

COMMENT OUTPUT AND PLOTTING INFORMATION )Ki|e>KJ|t)|cHoK)|C5K)|t)K>|o|o|{J|{ | 

kit r* X I ^ vk/ vi/ U/ U# il/ \L> \ly U/ U/ \t/ U/ U/ \L^ si/ W U/ ^ il/ U/ W \1/ ^ 'A 

I /fC JJv #1^ Jp #|\ Jp nv^p ^ ^ ^ 


OUTPUT i00> TIME ^ 

TIME f 

TIME > 

ft » « 1 

THETAX, 

THETA Y, 

THETAZ > 


TRNCOX> 

TRNCOY, 

TRNCOZ> 


WX , 

WY 

wz , 


WXEST F 

WYEST , 

WZEBT , 


WXD , 

WYD , 

WZD , 


COERRX> 

COERR Y, 

COERRZ, 


XCONON, 

YCONON, 

ZCONON, 


TDESRX, 

TDLSRY, 

TDEBRZ, 

ft ft ft ] 

TRWX , 

TRWY , 

TRWZ , 

* * * 

TSCX , 

T8CY , 

TSeZ , 

ft ft ft ’ 

FGJX , 

FGJY , 

FGIZ , 

ft ft ft i 

F8CX > 

FSCY , 

FSCZ , 

ft ft ft 

PMX , 

PMY , 

PMZ , 

ft ft * 

PMXD , 

PMYD , 

PMZD > 

ft ft ft ; 

PMXDD , 

PMYDD , 

PMZDD , 

ft ft ft 

sex , 

BCY , 

BCZ , 

ft ft ft 

SeXD , 

SCYD , 

8CZD , 


SCXDD , 

BCYDD , 

BCZDD , 


SeXPM , 

8CYPM , 

8CZPM , 


SeXOB , 

BCYOB , 

SezOB , 


SeXEST, 

SCYEST, 

SeZEST, 


SCXDPM, 

SCYDPM, 

BCZDPM, 


SCXDES, 

SCYDES, 

SeZDES, 

• • * j 

XHDD , 

YHDD , 

ZHDD , 

. . ♦ \ 

SeXAPM, 

SCYAPM, 

SeZAPM, 



DFE«RX, 
DFXCON, 
TNTERX, 
RANDOM, 
TDI8TX, 
NXQDER , 

PREPAR it , 

THETAX, 
WX , 
TSCX , 
F8CX , 
ABERX , 
ADERXD, 
PMZ , 
SCZ , 
SCXPM , 
SCXDPM, 
INTERX, 
TRNCOY, 

RANGE . . . 

THETAX , 
TRNCOX, 
WX , 
WXEST , 
WXD , 
COERRX, 
XCONON, 
TDESRX, 
TRWX , 
TSCX , 
FGJX , 
FSCX , 

sex , 

SeXD , 
SCXDD , 
SCXPM , 
SeXEST , 
PMX , 
PMXD , 
PMXDD , 
ADERX , 
ABERXD, 
SCXDPM , 
SCXDES, 
SeXAPM, 
DFERRX, 
Dl XCON, 
INTERZ, 
TDISTX, 
NXSDER , 


ORIGIMAL PACit* n 
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DFERRY, 

DFERRZ, 

DFYCON, 

DFZCON, 

INTERY, 

INTERZ, 

GASUSE, 

NJETON, 

TDISTY, 

FDISTZ, 

NXQDYN, 

DERPDY 

DERPDY, 

TIME , 

THETAY, 

THETAZ, 

WY , 

WZ , 

T8CY , 

TSeZ , 

FSCY , 

FSCZ , 

ABERY , 

ABERZ , 

ABERYD, 

ABERZD, 

PMZD , 

8CZEST, 

SeZD , 

SeZDES, 

SCYPM , 

SCZPM , 

SCYDPM, 

SCZDPM, 

INTER Y, 
GASUSE 

INTERZ, 

THETAY, 

THETAZ , 

TRNCOY, 

TRNCOZ, 

WY 

WZ , 

WYEST , 

WZEST , 

WYD , 

WZD , 

COERR Y, 

COERRZ, 

YCONON, 

ZCONON, 

TDESRY, 

TDESRZ, 

TRWY , 

TRWZ , 

TSCY , 

T8CZ , 

FGJY , 

FGJZ , 

FSCY , 

FSCZ , 

8CY , 

SCZ , 

8CYD , 

SeZD , 

SCYDD , 

SeZDD , 

SCYPM , 

SCZPM , 

8CYEST, 

SeZEST, 

PMY , 

PHZ , 

PMYD , 

PMZD , 

PMYDD , 

PMZDD , 

ABERY , 

ABERZ , 

ABERYD, 

ABERZD, 

SCYDPM, 

SCZDPM, 

SCYDES, 

SeZDES, 

8CYAPM, 

SeZAPM, 

DFERRY, 

DFERRZ, 

DFYCON, 

DFZCON, 

NJETON, 

GASUSE, 

TDISTY, 

FDISTZ, 

NXQDYN, 

DERPDY 
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M Cr KJ *y W ^ ^ ^ ^ ^ W W ^ sV ^ W ^ ^ ^1/ ^ %!/ il/ ilf si/ si/ sL' si/ si/ si# il/ si# sJ# s^ si# si# ^# si# tl# si# si# si# ^# si# s^ si# si# si# si# si# si# si# si# s^ si# si# si# si# 

COMMENT )|<)|()(C)K)K)ioioin«««)K)K)(ofoK)K)K)i()|oK)i()K DiURU LT MODEL )|()(()|()|()|()|()|()|t)|(H(«)i(«)|(H(Hci|()i(i|t«)fOiOK)K 

f f M M ^ |sj '¥* ^ ^ si# si# 4# si# s^ ^ si# si# si# si# si# si# si# si# si# s^ si# s^ si# si# si# sV si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# si# st# si# si#sl#sl#sl#sl#sl#sl#sl#sl# si# 

IT <WX.GT. 0.034907) WRITE; <6, SAT) 

IF (WY.GT. 0 .034907) WRITE <6, 8 AT) 

IP <WZ.GT. 0.034907) WRITE <6, SAT) 

SAT.. FORMAT <1X> '+'»++4-#-#++f-f GYRO SATURATION +++4-f-f+^+++-f M 

Jut JL| ^ iii ^ \|> i|> %i> ^ c|/ li/ 4|^ ^ kij 4ij 4ii klA 4ii ^ ^ 4|j klj 4i#i|^ l|/ fcl/ kii ki# ||j k^ klj k|l k|> kl/ ^ k|^ ^ ||j ^ ^ tl/ ll# %!/ tit tl/ til tl/ tl/ *1/ tl/ tl/ til til tl/ til tl/ 

wUnrifeilN I V W W W 

COMMENT )K)l()K)|o|c>lC)K)K)|()K)K)i(i|t)K)|oK«)(oK^)K)|( TCB SENSOR MODEL )|(H(}K)f()Ki|<)K)K)K}K)|()i()K)|nKHc)K)|oK)K)|OK)K 

/*t M J^l ki> ^ ^ kij |Ak k|> k|k kik ^ ^ «ftk ^ ^ ^ k|k ^ ^ ^ ^ ^ kjk k|/ kl/ k|/ klk k|/ ^ k|j l|*kA/ ki/ k|/ k|/ k|/ kl/ k^ y/ ki/ kl* ki/ kl/ til k|/ tl/ ti/ tl/ tl/ tl/ tl/ tl/ tl/ tl/ t^ ti/ tl/ 

^•/ w i» i^l HH IV I ^ ^ V ^ ^ ^ ^ ^ *n V ^ V m' ^ V ^ V V V /#' H' V V /|' ® ^ ^ T’ V ^ 

XNOlSE«GAUS8(0 . 0,50 . 0E“"6) ♦ SCXOD'«SCXPM-*XNOI8E 

YNOISE«'GAUSS(0. 0,50.0E-6) $ SCYOB««SCYPM'*YNOISE 

ZNOISE«GAUSS(0 .0,50 .OE-6) $ SCZOB-«>8C7PMf2:NOISE 

#*s #*s XfS k4 \ I *Y* si# si# s^ si/ si# si> si/ si# si# si# si# si# st/ si/ si# si# si/ si/ si/ si/ si* si# si/ si# si# s^ s^ si# si# si# s^ si# si# si# s^ si/ si/ si# si# s^ si/ si/ si# si# si/ sk* si/ si# si# st/ sJ/ si# ^/sl# si# si/ s^ si# ^Wsi# si# WW si# 

wUr»rll«*iI\ 1 V W W W* W W WWn JfC /[s #fC#(C#|s #(s Jp/|s #Js#J\#(v#|l#|( ?|C/|s V V ^ V V ^ ^ 

COMMENT #!|()|oK!|o|Oi)i{#)|oK»*)(oK>K ON BOARD COMPUTER PROCESSING 

/H (*\ W W k I ^y* ti/ tl/ tit tl/ U/ tl/ tl/ tl/ tl/ tl/ tl/ tl/ ti/ tl/ tl/ \L* tl/ ti/ \l/ tl/ tl# tl/ tl/ tl/ tl/ tl/ tl/ tl/ ti/ tl/ tl/ tl/ tl/ ti/ tl/ tl/ tl/ tl/ tl/ tl/ tl/ ti/ tl/ tL* tl/ U/tl/ ti/ tl/ ti/ tl/tl/ ti/ ti/ tl/ ti/ tl/ti/ t^ tl/ tl/ t^ ti/ 

wUnijl*«IV I 

DO INITJ $ JETON<J)«»0. 0 $ INITJ.. CONTINUE 

COMMENT GENERATE S/C TURN COMMAND INPUTS >f()|c)|a|t)K>|o|tJ|c)|o|tJK)|c)K)K)K 

IF (T.GE.TRNTIM) TURNON»<0.0 
TRNCOX«TRNCOX-<TRINCX)KTURNON+NADIRX 
TRNCOY^sTRNCOY-fTRiCNCYiKTURNON'fNADIRY 
TRNC0Z«TRNC0Z+TRXNCZ*TURN0N‘fNADIR2 


COMMENT att:i;tude rate estimator 

COMMENT ASSUME PERFECT ATTITUDE RATE ESTIMATION 

WXEST^WX f. WYEST^WY WZEST*«iWZ 

COMMENT gas jet RATE^POSITION ATTITUDE CONTROL )|(*)|<)fcj|c)|oKi|t)|o|o|t)|{ 


COMMENT COERRX“(TRNCOX-THETAX“-GJKRPX)KWXEST))KACSON 
COMMENT COERRY«« ( TRNCOY“TI-IETAY" GJKRPY)KWYEST) *ACSON 

COMMENT coerrz-<trncoz-thetaz~gjkrpz«wzi:.:st))|cacson 

COMMENT XCONON^^COMP AR <COi;;; RRX , ACSDB )- GOMPAR ( -ACSDB , COERRX) 

COMMENT YCONON«COMPAR <COERRY,ACSDB)-COMPAR (“ACSDB, COERRY) 

COMMENT ZCONON“COMP AR < COERR I , ACSDB ) -• COMPAR ( - ACSDB , COERRZ ) 

COMMENT ACS GAS JET FIRING LOGIC 

COMMENT IF (G JON . LT , 0 . 5) GO TO NOGJ 

NOGJ. . CONTINUE 

COMMENT REACTION WHEEL RAT E fPOSITION ATTITUDE CONTROL *tktt*^* 


TDESRXi=”RWKPTX*< (THETAX TRNCOX) ♦RWKRPX*WXCST))lcACSON 
TDESRY“-RWKPTY!K( (THETAY TRNCOY) fRWKRPY^WYES'DJiACSON 
TDESRZ“ "RWKPTZ#< ( THETAZ- TRNCOZ )■» RWKRPZtWZEST )»ACSON 


r 


1 


uRIUiriAt PAQR 
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COMMENT ♦*)|<)K*>l<»)K»}K)K)|OK»>K)K)|oK)K)|o|oK TCSil ALGOR XTHMO ♦«)!<♦. 

xnterx-«:i:nterx+bcxest>kacs;i:nc 
INTER Y'»' INTER Y+BCYEBT>KACB INC 
INTERZ»«XNTER3i:-*-8C2:EaTJ«AGBINC 

»FERRX«<-SCXEBT“XNTERX)KI)FXNI<X-»FI<RPX>«BCXDEB>)KTC80N 

DFERRY«»(-SCYEBT-XNTERY)f<DFXNI<Y-I>FI<RPY)KBCYDES>>KTCSON 

DFERRZ«<-8CZ:EST”"XNTER7*DFXNK2:“"I>n<RP2:)KSC/!:i)ES))|cTCB0N 

DFXCON^COMP AR (DFERRX , TCSDB > -COMPAR < "“TCBDB , DFERRX ) 

DFYCON“COMP AR (DFERR Y , TCSPB ) -COMPAR < -TCBDB , DFER R Y ) 

DFZCON«COMP AR < DFER R Z , TCBDB > -COMP AR < -TCBDB , DFERRZ ) 

IF < SCZDES . GT . -0 , 0 0 05 . AND . SCZEBT . LT . ZDBOFF > DFZCON^'X . 0 

COMMENT TC8 GAS JET FIRING LOGIC 

IF <DFON.LT. 0.5) GO TO NODF 

IF (DFXCON) XN,XOFF,XP 

XN.. JETON(ii>«!l . 0 $ JET0N<16)«*1 . 0 $ JETON(3>»X.O $ JETON<7)«i.O 
GO TO XOFF 

XP.. JET0N<i2)»i .0 $ JET0N<i5>«*l .0 <r> JETON<3)«1.0 JETON<7)«i.O 
XOFF. . CONTINUE 

IF <DFYCON) YN>YOFF,YP 

YN.. JETON<iO)*i . 0 $ JETON< . 0 $ JETON<i)“i.O i|i JET0N<5)«:i . 0 

GO TO YOFF 

YP . . JET0N(9) «i.O $ JETON( .1.4) «*i . 0 $ JETON<i)«1.0 JETON<5)«i.O 
YOFF.. CONTINUE 

IF <DFZCON> ZN,ZOFF,ZP 

ZN.. JETON< i i)«i . 0 f JETON< 12)=“i . 0 $ JETON( i 5)“»i . 0 f JETON< 16)“i . 0 
GO TO ZOFF 

ZP.. JETaN(2> »l.O $ JET0N<4) -^l.O $ JET0N<6) ««i.O $ JETON(B) . 0 
ZOFF. . CONTINUE 

NODF.. CONTINUE 


COMMENT )K)|o|olok!K)K3K)K)|{*)|t)»t!K)|o|{)K!J()loK}K GAS JET FUEL USAGE 

NJETON«0 . 0 
DO SUMJ J«l>16 
N JETON«N JETON4- JETON < J ) 

SUMJ.. CONTINUE 

GASUSE~GASUSE+NJETON>KGMFLOW)ttGJMOT 

COMMENT 

COMMENT ESTIMATOR PERFORMANCE EVALUATION 

COMMENT 

ABERZ=-ABS<SCZEST-SCZPM) $ ERZ«€RZ4-ABERZ 

ABERZD-ABS(SCZDES-SCZDPM) 4 ERZDeERZD4 ABERZD 
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ORIGINAL 1.7, 
OF POOR QUALITY 


M lyl Iwl *Y* ^ M/ 0/ ^ W sit ^ ^ ^ ^ W ^ ti/ ^ M/ M/ ^ ^ W W W %!/ ib ^ W W il^ ^ W %lf ^ W ^ ^1/ W 4 W ^ W iW W 

♦#wnrlC»*li I 

COMMENT >K)|C)(oioiof<$>K)K)K»)|{Halc$)loK FORCES AND TORQUES ON S/C )K)K»)(o|cilci|<>K#J|C5|0KX<iK#>lo(oK)K 

i*4 iyi MiT|ki *v* l|/ Utf ^ \i/ ^ \i/ tif tj# ii/ ^ ^u/ it/ \i/ ^ ^ ^ ii/ ^ ^ \i/ ^ ^ ^ ^ ^ ^ ^ ^ ^ iij ^ ^ Uf ^ U/ ^ ^ *1# ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ \b ^ U/ M/ yi^ y/ 


FSCX««FCJX+FDISTX 

FSCY«FGJY+F»ISTY 

FSCZ»FGJZ+FDI8TZ 

TSCXaTGJX+TRWX+TDISTX 

TSCYaTGJY+TRWY+TDISTY 

TSCZaT(3JZ+TRWZ+TDISTZ 


« FSC<1>««F8CX 
111 FSC(2>aFSCY 
m FSC<3)«FSCZ 
$ TSC<i>«TSCX 
$ T8C<2)«TSCY 
« TSC<3)aTSCZ 


COMMENT >K>K)|oK>K}«>KiK)|C!KK()K#)K}KJ|ciKJK)|{ ESTIMATOR FORCE MODEL )|()(()|<>Km>lc)lC)K)lnKJ|C)K)K)K)K)|o|oKHc 

ESTFMX«FfijX+FSRH(SIN < THETAY-NADI R Y > 

E8TFMY«FGJY 

ESTFMZaFGJZ-FSRJ|tCOS<THETAY-NAD:i;RY> 

COMMENT )K)f(i(()|(!|()l<)|(}K)K)j()K}|()|()|()|()|()i()i()|()|()|()i()|(i|()i()|()l(i|()K!ic)t(9|(}|(>l<)i(>K!l(>KiK)K«)|(i|(}(()ioK)|c)KiK)|(9K9|0|t]io|<;j(9K)KHt!|oio|c)K 


DERIVATIVE STAR $ CINTERVAL CI«0.010 ^ HMINTal.E-iO 

XERROR WX «>1.E““4 ,WY «i . E-4 ,WZ «1 . E-4 
MERROR WX ai.E-4 ,WY ai.E--4 ,WZ «l.E-4 
NOSORT 

NXQDERaNXODERM . 

COMMENT )K*)K)K)K)({)K)K)KHc*)KJ|c)K)K#)K)K)KJK PM AND S/C DYNAMICS )|t)K>|<!|c>l<)|£iKJKHcHoK$>Ki|{)KiK*!j{)K>loK)|c 

/*\ tut V I *Y* vi> %|4 4i# U/ tl/ ii> il> vl/ U/ \1> vl> vl/ U/ it/ \1/ 0/ \1/ U/ \1/ \l/ kI/ ii/ vl/ vl/ \1/ %!/ ii/ il/ il/ \1 j it/ vi/ it/ it/ it/ it/ it/ it/ il/ it/ it/ it/ it/ il/ it/ it/ it/ it/ it/ it/ it/ it/ 

W U nijfcilx I ?|i/|i#^/Ji/|>/Ji/Iv/|i/|i/p/|'^^/|'/F^/|'/|>/|i^/|'V^***V***^^^V*^V 

COMMENT PM MOTION IN INERTIAL COORDINATES 

PMXDD«*0.0 m PMYDDaO.O « PMZDD«“-8CZPM)kIDK2)KIDV0LT)|!#a 

PMXD aO.O $ PMYD aO.O » PMZD »INTEG<PMZDD,PMZDI ) 

PMX «0.0 in PMY «0.0 $ PMZ »»inTEG(PMZD,PMZI ) 

COMMENT Hc*)|{)|{)|()jo|oK)|t)K S/C ACCELERATIONS IN INERTIAL COORDINATES *H<i|oK>Ki|!)K>|o|oK 

WXD , WYD , WZD«HCK < RATE > SC INRT , WX , WY , WZ > TSCX , T8CY , TSCZ > 
SCXDDaFSCX/SCMASS $ SCYDD«=FSCY/SCMASS $ BCZDDaFSCZ/SCMASS 

COMMENT >|oK)|tN<)|OK>Kilt*HO|o|t)k>li!K)K#!lt S/C RATES AND POSITIONS J|t)K)|c*iKJ|{)|i#>|iHo|tJ|oK>K>lo|oK)K>K>K 

WX aj;NTEG<WXD/WXI) 

WY «>1NTEG<WYD,WYI> 

WZ «>INTEG<WZD;WZI) 

PZD,PlD>P2D,P3D«HCK<HCI<,PZ,Pt,P2,P3>WX,WY,WZ) 


PZ 

«INTEC<PZD>PZI) 

Pi 

U«1NTEG(P1D,P1I) 

P2 

«=INTEG(P2D,P2I) 

P3 

aINTEG<P3D,P3I) 

SCXD 

aINTEG(8CXDD,8CXDI) 

SC YD 

«=>INTEG(SCYDD,SCYDI) 

SCZD 

aINTEG<8CZDD,8CZDI) 

sex 

»INTEG(SCXD,SCXI) 

SCY 

aINTEG(SCYD,SCYI) 

sez 

»-INTEG<SCZD,8CZI) 
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oimmi PAnn: n' 

OF P00|{ QUALITY 


COMMENT 

COMMEN'”' )|<)«>|o|{*)K#>KiK>K$>K)lo|OKiKiK$)lo|ol< DTSTURWANCE MODEL >K)l()l<>{<*>l<)|i)l<H<!l<)l<i|t)|oK)l<ilOKiK#)K>K)KiK 
COMMENT 

T F < I) :i: STON . LT . 0 . 5 > 00 TO N0DI9 T 

R ANDOM«‘OU( F8RCTC , T , FBRCIC , FOR ) 

F D X S TX «" R AND OMH< S I N < T l-IE T A Y •••■ NAD X R Y ) 

FDI8TYs«0 .0 

fdistz«>-“RANdom!KCOs<thetaY""NAd:i;ry> 

COMMENT CENTER OF PRESSURE CALCULATXON 

COMMENT CPX*«0.0 $ CPY««0 . 0 f CPZ^O.O 

COMMENT CMTCPX««CPX“SCCMLVa ) 

COMMENT CMTCPY»CPY“"8CCMLV<a) 

COMMENT CMTCPZ^CPZ-SCCMLUC?) 

COMMENT TDISTX»+FDI8TZ)KCMTCPY“FDI8TY#CMTCP2: 

COMMENT TDISTY^-FDISTZiKCMTCPX^-FDIBTX^CMTCPZ 
COMMENT TDISTZ«»+FDI8TY«CMTCPX"-FDISTX>KCMTCPY 


NODIST.. CONTINUE 

COMMENT ###)!< 

COMMENT REACTION WHEEL INDUCED DYNAMICS 

COMMENT 


TRWX“ < BOUND < -“TR UMAX > +TR UMAX > TDE8RX > ) )«RWON 
TR WY- ( BOUND < -“TRWMAX , +71? UMAX , TDESR Y ) > *R WON 
|RW4-^"<BOUND<-TRWMAX,-*-TRWMAX,TDESRZ))#RWON 


COMMENT 

COMMENT )|c)K # It *Jl< #>!<#♦ GAS JET INDUCED DYNAMICS >K)l<H<*5K5|o|C)|a|t)KH<5|(Ht)|ti|t)|t)foKJ|t>|t 
COMMENT )|()|t)|oK)|o|t)|i)|t)|t)|o|t)|ti|t>Ki|t!K##>lt>l<)(t!|t>H!|t)|tHo|t)(o|t)|t>lt>K#Ht)|t>lo|tH<>l<#i|tH<i|t>lo!<HotoK>lt)ltJ|tHtHt#>k5|tHt>|t5|t>|o|f>|t5|t 


SUMF . . 


K«0 % FGJ(i)«0.0 


FGJ<2)«0.0 FGJ<3)«0.0 


JP8«=JfS $ IP9“Jt-9 


DO SUMF J=i,7,2 
K®K+i H» JPi^^J+l * 

DO BUMF 

FG JC < K , J J ) “C JFU < J , J J ) )K JETON < J ) +0 JFU < JP 1 , J J ) ♦ JETON < JP 1 ) 

GJFV < JP8 , T J ) HtJETON < JP8 ) ■♦•G JFU < .TP9, J J ) JETON < JP9 


) 


FG J < J J ) ‘••'FG J < J J > •♦•FG JC < K , J J > 

CONTINUE 

FGJX>»FGJ<i) FGJY‘aFGJ(2> ^ FGJZ«FGJ<3) 


TGJX'“'0.0 ^ TGJY“«0,0 TGJZeO.O 

DO SUMT Jsi>4 

TG JC < J , 1 ) »•♦ FG JC < J , 3 ) *CMTG JU ( J , 2 ) - FG JC ( J , 2 ) »CMTG JV ( J , 3 ) 
TG JC < J , 2 ) s'-FGJC < J , 3 ) >KCMTG JU ( J , i ) +FG JC( J > 1 > *CMTG JV < J > 3 ) 
TG JC < J , 3 )=-^FG JC ( J , 2 )*CMTG JU < J , 1 ) FG JC < J , i ) #CMTGJU ( J , 2 ) 
TGJX^TGJX-fTGJC(J>l. ) 

TGJY«TGJY+TGJC(J,2) 

TGJZ=‘«TGJZ4TGJC<J,3) 

SUMT.. CONTINUE 


ORIGIMAl 13 
OF POOR QUALITY 


73 


COMMENT $)|0K>|0H)K* 8/C ACCELERATION, 


rati; 


POSITION RELATIVE TO PM 


8CXAPM«8CXDD-PMXD» $ 
8CXDPM»"8CXI>“«PMXD « 
8CXPM«"8CX-“PMX 


BCYAPM'«8CYDD-PMYDD 
BCYDPMwSCYD-PMYI) f 
8 CYPMw8CY-PMY 


QCZAPMs'SC/DD-PMilIDD 

SCZDPM-nSCIID-PMYD 

aCZPM««8C2~PMY 


COMMENT 

COMMENT TC8 ESTIMATOR EQUATIONS 

COMMENT 


CMAX«*ESTEMX/8CM AS8+P MXDD 
CMAYwE8TEMY/SCMA8S>PMY»D 
CMAZ»E8TFMZ/SCMASS+PMZI)D 

FP21 »'Pii>l<(WY)|tWY4-WZ#WZ)+P31)|t<WZD •WX)KWY)+2. 0)KP4i>KWZ""PSi 
JK(WYDfWX)KWZ) 0)KP<i>l)KWY 

FPJ'2 «P21)K<WY)KWY4WZ)KWZ>'*P32)K<WZD"»WX#WY>'fa.0)KP42#WZ""PS2 
JK < WYD-4 WX1KWZ > -2 . 0 )KP62)KWY 

FP23 «=P3i» < WY#WY4 WZ)KWZ> -f P33# < WZD“WX#WY >4-2 . 0JKP43#WZ-PS3 
*<WYI)+WX)KWZ) -2. 0»P63!KWY 

FP24 «*P4i*<WY*WY4WZ)KWZ)+P43)K<WZD“WX>KWY)4-2.0)KP44)KWZ““PS4 
JK<WYD4-WX)KWZ>-2.0H<P64*WY 

FP2S «<PSi$<WY5|tWY-fWZJKWZ)+PS3)|{<WZD“WX)KWY)-'-2.0>KPS4#WZ“P8S 

* ( WYD4 WX»WZ > -2 . 0 >KP65)KW Y 

FP26 «»P6i!|t<WY#WY4<WZ)KW2>4.P63>k<WZD-WX*WY>4-2.0>KP64)KWZ“-P&S 
)K<WYI)4 WX!KWZ)“"2. 0*P66)KWY 

ta~PU)K<WZD4-WX)KWY>~2. 0)KP2i»WZ+P3i)K<WX)|{WX-fWZ*WZ>4-P5i 

* ( WXD"» W Y JltWZ ) + 2 . 0 X< P 6 DK W X 

FP42 «~P2i>K < WZD+WX)KWY > -2 . 0>KP22#WZ4* P32* < WX)|tWX4-WZ*WZ) 4-P52 
)K<WXD-WYi|tWZ) + 2. 0>KP62*WX 

FP43 a-P3t>K<WZDfWX)KWY> “2. 0*P32)KWZ4P33>K<WX<(WX-fWZ)KWZ)4-PS3 
)K<WXD~WY)|{WZ) f2. 0)KP63#WX 

FP44 a-P4iH<<UZ»4-WX)|tWY>“2.0>KP42>KW24-P43)K<WX)|tWX4-WZ5l<WZ)4-PS4 
)K(WXD""WYi|tWZ>4-2. 0>KP64)|tWX 

FP4S ia-PSi>k<WZD4-WX»WY>-“2. 0)KPS2)|{WZ4-P53)K<WX)|tWX4-WZ}KWZ>4-PS5 
)K < WXD “W Y)KWZ ) +2 . 0 )KP65)|{WX 

PP46 t«-~P6i>l< ( WZD+WX*WY ) “-2 . 0#P62)|tWZ4-P63>l( ( WX)KWX4-WZN(WZ) 4.P6S 
>fcflJXD""WYiy7)42 n!l<P<!i6)i(UlX 

FP6i aPii)K(WYD"WX*WZ>4-2. 0>KP2i)KWY~P31)K<WXD4-WY)l<WZ) “2. 0# 
P41 )kLiy4'P5l ;(< nJXlkLIX4'UIY)l(lJY ) 

FP62 aPL»i»(WYD“WX>KWZ)4-2. 0«P22HtWY-P32!K<WX»4WY)lCWZ) "2. 0* 
P4P)klJX4P8P>l( (UXtUIX fUYUtUY ) 

FP63 aP3l5K<WYD"WX*WZ)42, 0)KP32)KWY"P33*<WX»4-WY)KWZ>"-2. O* 
P43»W24 P83)K < WX>KWX4 WY*WY ) 

FP64 aP4i*<WYD-WX>KWZ>4-2. 0)«P42#WY-P43)K(WXD4-WY3|tWZ)"-2. OJK 
P44)kU74 P f yy AUX f UYALIV ) 

FP6S aPBl*<WYD"-WXH<WZ)4 2. 0)KP52*WY" PS3*<WX»4-WY)KWZ) -2. 0# 
P^4<(U174 l‘’Ci'^»5k ( UXtUIX * UIY*IJY ) 

FPA6 aP61)|t<WYI)-WX)KWZ)4 2. 05KP62*WY-P63Y(WXI)4-WY*WZ) 2. 0)K 
P64)KWZ4P65$<WX*WX4-WYi|tWY> 


1)11. aPll»l>ll+P31)KP3i 4PSDKPS1 
1) 2 1 a P 1 1 )K p 2 1 4' P 3 1 $ F> 3 2 P 5 i H< P S 2 

I) 3 1 p 1 1 * p 3 1 4 P 3 1. )K P 3 3 4' P S .1 * P 5 3 

I) 4 1 ^ T» 1 1 * P 4 i 4 P 3 i « P 4 3 4 P 5 i P S 4 

D'U ap ii)KI'M:il4P31 ♦P534P51»P55 

DAI ~:P1 1 *PA1+P31 *PA34P5i)KP6S 


< *> 


lY''' i';i 

or pon;: 

74 


Daa "«pa i )Ki»si •♦•p 3a)({p 3;,;i+p ^'I;»)Kp *!»a 

Disa I'lpa i )KP 3 i +p 3a)Kp 3 3f p sa )KP *33 

D-42 ""P 21 >KP 4 .1, +P 32 H<P 4 3 'fP S2)KP 54 

I>52 ii"P21 JKP 5 1 +P 32>KP S’lJ+PSaJKP 55 

1)62 "«P2i)kP61'fP32>KP63^P52>l<P65 

D33 >«'P 3DKP 3 1+P 33#P3 3+P S3H<P 53 

I>43 •wP3i)KP41+P33>KP43'»'PS3>KP54 

I>53 »P31 >KP 5 14-P 33*P S3'«-P 53>KP 55 

D63 •«P3i)«P61+P33)KP63+PS3)KP6S 

D44 ««P 4 1 HCP 4 1 •♦■P 4 3)KP 4 3+ PS4 X<P 54 

054 >^P 41 )KP 5 1 +P 43 H<P S3 •♦■P 54)KP 55 

064 ““P 4 1 >KP 6 H- P 4 3*P 6 34- P S4 X< P 6 5 

055 “P51*PS.1+P53)KP53')'P555KP5S 

065 «‘P 51 >KP 6 1 4-P S31KP 6 3'*' PS5>j<P 65 

066 “P61*P61-^P635«P63^P6S*P65 

P 1 1 X N TEG < 2 . 0 >KP 2 1 -R )« 0 U , P 11 X ) 

P21 >«XN1EG<P22'fFP2i-R)KD21 ,0.0) 

P31 «»INTEG'<P32-* P4l-R>i<031,O . 0) 

P 4 1 «• X NTEG < P 42 -fP P 4 1 •••• R JKD4 1 , 0 . 0 > 

PSl «XNTEG<P52-f-P61-R)K 051,0.0) 

P61 «<XNTEG<P62 fFP61-R>K061 , 0 . 0 ) 

P22 «INTEG(2. O*FP22+SO;PX“R)K022,P22X) 

P32 «<XNTEG<P42'fFP23-R»D32, 0 . 0 ) 

P42 aXNTEG<FP424*FP24*“R)K042,O . 0) 

PS2 «XNTEG<P62‘fFP25-R*052,O . 0 ) 

P62 aXNTEG<FP62-) FP26“R*062, 0.0) 

P 33 «X NTEG <2.0 H<P 43-R >K033 , P 33X ) 

P43 «XNTEG<FP43-*P44-R)«D43,0 . 0) 

P53 aXNTEG<P63>K P54-R)«053, 0 . 0 ) 

P63 «>XNTEG<FP63-*P64”R)t<063,0. 0) 

P44 »XNTEG(2. 0)KFP444-BGPY-R)|<D44,P44X) 

PS4 “INTEG(P64-*FP45 •RH<0S4,O. 0) 

P64 «XNTEG<FP64)FP46-R)K064,O . 0) 

PSS «INTEG<2 . OH<P65“RHC055,P55X ) 

P65 aXNTEG<FP6S4-P66“"R>|{D65, 0 . 0 ) 

P66 «‘INTEG(2. O)HFP66+SGPZ“"R)l(066,P66:i:) 

LLXH ®SCXE8T-80CMXE Hi I...LXH0«>8CXDE8 

LLYH aSCYEST-BCCMYE % LLYH0»«SCY0ES 

LLZH ««8CZEST-SCCMZE $ U...ZH0aBCZ0ES 

XH00 a4-CMAX4- < WYlKWYfWZXfWZ ) JKLLXHf ( WZ0-WX!KWY) )«<LI...YH 

•♦•2.O>KWZ*LLYH0~(WY0“-WX!KWZ)>KI...LZH-2 . O#WYjKLLZH 0 
YHD0 « *GMAY-"(WZI) fWX*WY) #I...LXH -2 , O>KWZ)|tLLXH04- ( WX*WX 
•♦•WZ>KWZ)*U..YH'f<UIXD~WY)t(WZ)*LLZH+2. O)KWX)KLLZH0 
ZHD0 ~+CMAZ-<'<WYI)""WXH<WZ).«I...I...XH-<'2 . 0)KWY)(tU..XI 10- < WX0 

•♦•WYJKWZ ) *t..LYH -‘2 . O)KWX)KLLYH0i ( WX>KWX-HJY*WY ) )KLLZH 
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qF pOO« QUftWix 


COMMENT ESHMATEP 0/C RATEIi) AND PCIOrrXDNO REEATIMII- TO THE PM 


OCXEOT»"3:nTER < OCXI)EO-fRX< < P ;l, .1, 
■♦'Ps,i.)K<BCz:pi!i™scziii:aT> 
8CXDEB'»'XNTEG ( XMI)I)'»R>K < PS A « < 
•♦•psg»*<BC2:(:)B'-BC2:ii!:BT> 
BCYEBT""3:NTEB<BCYI)EB-fR)K<Pa^, 
■♦■PS3#(BCZDB“'8C2:i:;:sT) 
BCYDEB'mTNTEG < YHDD-tR* <P41)K < 
•♦•PS^^CBCZOB-BCZEBT) 
BCZEBT"' 1 NTEG < BCZDES+R >K < P B i 
•♦•PSS)K<BCZDB“"8CZIii:BT> 
BCZ1)ES»»| NTEG < ZHDDfR )K < P6 i >K < 
•♦•P6B>k(BCZ0B-SCZIH:8T> 


)K ( BCXC)K('-'B CXE BT ) tP 3 1 H< ( BC YOB -BC YEB T ) . 
> , BOXES, T > 

BCXOB-'BOXIiL’ST > ■♦■P 32)K ( BCYOB-BOYEBT > , 

> , 80X10E.T. > 

# ( BOXOB'-BCXEBT > ■♦•P3;TH< <80 YOB-BO YE8T ) . 
> , BOY ESI ) 

SCXOB-SOXEST > 43)H < BCYOB-BOYEBT ) . 

> ,8CYBEI> 

#<BOXOB”"BOXEBT)+PS3H<<80YOB-BOYEBT> . 
> , 8CZESI > 

SCXOB-SOXEST > ■♦•P63H( < BCYOB-SCYEBT > . 

> ,8CZDEI> 


i*\ Xi ki E** k I *V* ti/ U* vLf vl« vt> U# U* il/ U« 4|> vIj il> Ui kl/ lL> \it d# kl> U/ Ui kl/ kli kl/ kl/ df kl/ di kl# d> kti kL kl/ kli kl/ ktf kJ> kl# kl/ d/ kl^ kl/ ki/ kl> kl/ kl^ kl# kl/ kl^ kl/ d/ kl# U/ d/ d/ kl# kl/ kif 

k«/ k*r n n Cii I o' ^ »!' V 'I' V V ^1’ •I' ^ V V V 'I’ •I’ ^ V 'I' V V V »!' ^ V 'I' ^ ^ V H’ n' ^ V 'o * * »p V V H’ M' ^ ^ V ^ ^ V 

ktr n n (h4 I O’ T’ ’I’ O' O^ ^1’ O^ O' •I’ •I' O' O’ M’ ’I’ ’O o' *1' 0> »|k J|k »|k ?|k O’ •i' O' •I’ O' m' O' O' m' O' ^P ^p 


END 

END 

END 


TERMINAL 

FIN.. CONTINUE 

AUERX»«ERX/NXQDYN $ AUERXD»<ERXD/NXODYN 

AUERY«»ERY/NXG|DYN % AUERYD«ERYD/NXQDYN 

AUERZ«ERZ/NXQDYN « AUERZD>«ERZD/NXG|DYN 

DEBUG 

NXQTER«<NXaTER+J. . 

WR ITE < 6 > F2 ) T , NXQ I NT > NXQD YN , NXQDER , NXQTER , DERP DY 
F2>. . FORMAT <lX^6Gi4,B> 


END 

END 
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Thifl app(3ndix is a Butnmary of roflultB Riven In a detailed study 
by M. Hnrel et nl of JPL (7). 

A preliminary analysis of charging of the proof mass during the 
Starprobe Mission reveals that the Jovian environment is the largest 
contributor of charging currents. For our study we performed Quantitative 
estimates for the following environments: a) cosmic ray, b) Jovian 

environment (considering perijoves of 3Rj and 9Rj), c) Solar environment 
including the radiation due to solar flares. 

We find that the cosmic rays will result in a positive charge of 
3,3 X 10 coulomb for a five year mission. The Jovian envi-onment will 
give a negative charge of 5, 2-5, 3 x 10“^ coulomb. The typical large solar 
flare environment is expected to result in a maximum pooitlve charge of about 
1 X 10 coulomb which is also small compared to Jovian environment (see 
Table 1 below) , 

We should comment that this study will only give order-of -magnitude 
type results. To achieve better estimates of the charging currents one 
would have to do a more careful study that includes secondary particles, 
neutron fluxes and more precise trajectory. The table below summarizes 
our findings. 


Table 1, 

Proof Mass 

Charring for Starprobe Mission 

Phase 

Electron 

Proton 

Ret Charge 

Charge per 

Current 

Current 

Current Per Day 

Misalon Phase 


(A/Cm^) 

(A/Cffl^) 

(A/Cm^) (Coulomb/Cm^- 

Coulomb 




day) 


Coomlc Ray 

5.12x10"^^ 

6.09x10"^° 

5.57x10“^'^ 4.8x10“^^ 

3.3x10"^^ 

Jupiter 

(3RJ) 

4.67x10”^^ 

1.07x10"^^ 

-4. 66x10"^^ -4.02x10"^ 

-1.53x10“® 




(1 day) 

Jupiter 

(ARJ) 



-1.38x10“^ 

-5.2x10"^ 





(1 day) 

Solar Enc. 





Typical 

Large 



-10 

Klaro 




1x10 
(1 day) 


Upper LitnU 


